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Preface 


This  study  is  part  of  a  continuing  effort  to  design 
a  tracking  system  for  use  in  a  ground  based  laser  system 
under  development  by  the  Air  Force  Weapons  Laboratory. 

A  correlator/Kalman  filter  which  uses  infrared  sensor 
data  was  synthesized  and  tested. 

I  wish  to  express  my  appreciation  to  my  thesis 
advisor.  Dr.  Peter  S.  Maybeck,  for  his  expert  guidance 
and  enthusiastic  support  during  this  project. 
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Abstract 


Over  the  past  four  years  considerable  work  has  been 
accomplished  at  the  Air  Force  Institute  of  Technology  to 
improve  the  tracking  capability  of  the  high  energy  laser 
weapon  against  airborne  targets.  In  this  research,  many 
of  the  prior  concepts  are  incorporated  into  a  correlator/ 
Kalman  filter  to  develop  a  tracker  capable  of  providing 
precise  target  position  estimates  in  a  dynamic  short- 
range  environment  using  a  Forward  Looking  Infrared  sensor 
(FLIR)  to  provide  measurement  data.  Digital  signal 
processing  is  employed  on  the  FLIR  data  to  identify  the 
underlying  target  intensity  shape  function  when  the  target 
under  consideration  has  either  single  or  multiple~~^hot 
spots^.  The  estimated  target  shape  function  is  then  used 
as  the  template  in  a  correlation  algorithm,  where  spatial 
and  frequency  domain  correlation  techniques  were  explored, 
to  determine  the  offsets  between  the  template  and  the 
incoming  measurement.  These  offsets  are  used  as  # 
"pseudomeasurements"  in  a  linear  Kalman  filter  which 
exploits  knowledge  of  the  process  dynamics  and  statistical 
knowledge  of  the  correlator  errors  to  enhance  the  position 
estimates . 
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ENHANCED  TRACKING  OF  AIRBORNE  TARGETS 
USING  A  CORRELATOR/KALMAN  FILTER 


I.  introduction 


The  rapid  growth  in  laser  technology  since  the  early 
1960's  has  led  researchers  in  a  wide  variety  of  disciplines 
to  investigate  possible  applications  of  this  device.  The 
unique  characteristics  of  the  laser  make  it  a  highly 
desirable  weapon  system,  with  one  prospective  military 
application  involving  the  use  of  laser  energy  to  destroy 
airborne  targets  (1:14-17,  2:16-19).  Since  the  directed 
energy  is  transmitted  at  the  speed  of  light  from  the 
source  to  its  destination,  the  energy  arrives  at  the 
target  almost  instantaneously,  eliminating  the  need 
for  lead  computation.  Additionally,  the  laser  can 
potentially  deposit  large  amounts  of  energy  on  a  target 
in  a  short  period  of  time,  thereby  destroying  or  disabling 
the  target  without  firing  an  expensive  missile  for*  each 
engagement  opportunity  as  in  conventional  systems. 

In  actual  implementation,  this  system  requires  a 
high  energy  laser,  a  very  accurate  pointing  system,  and  a 
very  accurate  estimate  of  the  target  position.  The  precise 
pointing  control  and  target  position  estimates  are 
required  to  concentrate  the  directed  energy  on  a  specific 
part  of  the  target,  instead  of  "painting"  the  entire 
target  with  energy,  and  to  maintain  the  laser  beam  on  the 
target  long  enough  to  disable  the  target. 

1 . 1  Background 

This  study  is  a  continuation  of  other  research 
projects  conducted  at  the  Air  Force  Institute  of  Technology 


(AFIT)  over  the  past  four  years  which  have  investigated 
possible  solutions  to  the  target  tracking  problems 
associated  with  directed  energy  weapons.  Currently,  the 
Air  Force  Weapons  Laboratory  (AFWL)  uses  correlation 
trackers  to  provide  precise  target  position  estimates  to 
feedback  controllers  in  the  presence  of  disturbances. 

These  disturbances  include  any  effect  which  can  cause 
relative  motion  between  the  beam  and  the  target,  such  as 
true  target  motion,  atmospheric  jitter,  and  sensor  measurement 
errors  (3:2).  A  correlation  tracker  compares  new  target 
information  received  from  a  sensor  with  a  template, 
consisting  of  either  predetermined  or  previous  real-time 
data.  Correlation  techniques  are  then  used  to  estimate 
the  relative  position  offsets  from  one  data  frame  to  the 
next.  This  relative  position  information  is  then  used 
to  drive  the  tracking  servo  error  voltages  in  azimuth 
and  elevation  to  keep  the  target  image  centered  within 
the  sensor's  field-of-view  (FOV) .  Although  various 
sensors  capable  of  providing  target  position  information 
are  available,  the  one  currently  of  the  most  interest 
due  to  its  passive  nature,  and  the  one  which  will  be  used 
in  this  research,  is  the  Forward  Looking  Infra-Red  sensor 
(FLIR)  (4) . 

The  correlation  algorithm  is  well  suited  to  many 
practical  applications  because  this  methods  requires  no 
a  priori  information.  However,  in  many  tracking  situations 
certain  target  parameters  such  as  shape,  size,  and 
acceleration  characteristics  are  either  known  or  could 
be  estimated,  which  would  enhance  the  tracker's  ability 
to  estimate  the  true  target  position.  The  effects  of 
atmospheric  disturbances  on  radiated  waveforms  are 
known  and  statistical  data  could  be  used  to  separate  the 
true  target  motion  from  apparent  motion  due  to  disturbances. 
This  separation  is  crucial  since  the  directed  energy  beam 
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does  not  undergo  the  same  distortion  as  the  infrared 
wavefront  eminating  from  the  target.  Additionally, 
statistical  data  on  FLIR  noise  and  background  noise  is 
available,  and  can  be  used  to  provide  a  better  estimate 
of  the  target's  true  position  (5:222).  The  desire  to 
exploit  this  knowledge,  unused  by  the  correlation 
trackers,  led  researchers  at  AFIT  to  investigate  the 
possibility  of  designing  an  extended  Kalman  filter  as 
an  alternative  to  correlation  trackers.  This  method  was 
selected  because  the  reduced  computational  loading 
incurred  with  implementing  this  filter,  when  compared 
to  other  nonlinear  filters  is  great  enough  to  warrant  an 
evaluation  of  its  performance. 

An  extended  Kalman  filter  can  incorporate  estimates 
of  target  parar^ters  such  as  size,  shape,  and  acceleration, 
as  well  as  statistical  information  on  the  effects  of 
atmospheric  distortion  on  radiated  wavefronts,  and  sensor 
errors,  to  aid  in  separating  the  true  target  motion  from 
the  apparent  motion  created  by  disturbances.  In  initial 
research  efforts,  the  extended  Kalman  filter  outperformed 
the  correlation  tracker  against  targets  exhibiting  a 
single  point  source  of  infrared  radiation,  or  "hot  spot", 
when  the  intensity  function  was  relatively  well-known 
by  the  filter,  and  the  internal  filter  structure  was 
designed  to  depict  the  tracking  environment  to  be 
encountered  (5,6).  The  performance  enhancement  achieved 
by  the  extended  Kalman  filter  under  these  controlled 
conditions  led  to  further  efforts  to  design  a  filter 
capable  of  accurate  tracking  in  an  environment  when  the 
target  intensity  pattern  on  the  FLIR  image  plane  is  not 
well  known  a  priori  (7,8).  Additionally,  as  in  realistic 
situations,  the  tracker  has  to  be  capable  of  tracking 
targets  exhibiting  both  single  and  multiple  hot  spots 
which  change  in  time,  so  the  target  intensity  pattern 
must  be  identified  in  real  time. 
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In  the  thesis  by  Captain  S.K.  Rogers  (8),  a  digital 
processing  algorithm  was  developed  which  is  capable  of 
identifying  the  target  intensity  pattern  in  real  time 
for  a  single  or  multiple  hot  spot  target  when  neither 
the  functional  form  of  the  target  intensity  nor  the 
number  of  hot  spots  is  known  a  priori.  This  algorithm, 
shown  in  the  upper  path  of  Figure  l.and  detailed  in 
section  1.2,  was  implemented  by  Rogers  in  two  trackers. 

The  first  tracker  used  the  estimated  target  shape  intensity 
directly  in  the  measurement  model  of  an  extended  Kalman 
filter  while  the  second,  tracker  used  the  estimated 
target  shape  as  a  template  in  an  enhanced  correlator  to 
provide  target  measurement  information  to  a  linear  Kalman 
filter.  A  linear  Kalman  filter  can  be  utilized  in  this 
tracker  because  the  outputs  of  the  correlation  algorithm 
are  offset  distances  which  are  linear  functions  of  the 
chosen  state  variables  (see  Chapter  3) .  Both  trackers 
exhibited  significant  performance  potential  against 
targets  having  benign  dynamics,  with  the  extended 
filter  having  larger  mean  errors  and  the  correlator 
filter  having  larger  standard  deviations  (8,9) .  However, 
the  reduced  computational  burden  associated  with  tile 
actual  implementation  of  the  correlator/Kalman  filter, 
and  the  enhanced  potential  of  using  this  filter  with 
optical  processing  alternatives,  strongly  urges  further 
investigation  of  this  approach  (9) . 

1.2  Problem  Overview 

The  purpose  of  this  research  is  to  expand  on  the 
Rogers'  work  by  investigating  the  feasibility  of 
utilizing  a  linear  Kalman  filter  in  cascade  with  a 
correlation  algorithm,  using  either  the  correlation 
method  employed  by  Rogers  or  an  alternative  method  as 
developed  in  Chapter  4 .  Alternative  correlation  methods 
were  explored  to  determine  if  either  a  reduction  in  the 
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computational  loading  of  the  correlator  could  be  achieved 
without  a  degradation  in  performance,  or  another  method 
is  available  which  reduces  the  mean  errors  and  standard 
deviations  of  the  correlator  without  a  substantial 
computational  increase.  The  ability  of  the  correlator/ 
Kalman  filter  to  track  targets  exhibiting  single  and 
multiple  hot  spots  over  a  varying  range  of  dynamic 
profiles  will  be  evaluated.  These  dynamic  profiles  were 
specifically  designed  to  evaluate  the  ability  of  the 
filter  to  track  changes  in  the  target  dynamics  as  well 
as  changes  in  the  target's  intensity  pattern.  The  target 
scenarios  and  reasons  for  selection  of  those  scenarios  are 
detailed  in  Chapter  2.  In  the  single  hot  spot  case,  the 
performance  achieved  by  the  extended  Kalman  filter 
employed  by  Harnly  and  Jensen  (6)  will  serve  as  the 
standard  against  which  the  correlator/Kalman  filter 
performance  will  be  evaluated. 

As  shown  in  Figure  1.,  measurement  information  of 
target  position  for  the  correlator/Kalman  filter  is 
generated  by  the  FLIR  sensor.  In  this  research  the  FLIR 
tracking  window  is  8  pixels  wide  by  8  pixels  high  where 
a  pixel  length  of  20  y  radians  is  used,  although  ar> 
expansion  of  this  window  is  possible.  The  measurement 
information  presented  to  the  tracking  algorithm  is  the 
average  intensity  over  each  of  the  64  square  pixel 
elements  within  the  8x8  tracking  window.  The  concept 
of  the  correlator/Kalman  filter  is  to  generate  an  accurate 
reference  image  of  the  target's  intensity  function  on 
the  FLIR  image  plane  to  serve  as  a  template  for  correlation 
with  new  data  received  from  the  sensor.  In  Figure  1., 
either  path  1  or  path  2  is  followed  depending  on  the 
correlation  method  being  used.  The  results  of  the 
correlation  of  these  two  data  arrays  namely,  the  indicated 
angular  position  offsets  of  the  target  centroid, 

Equation  (1-3),  from  the  center  of  the  FLIR  f ield-of-view 
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(FOV) ,  can  then  be  used  in  the  measurement  model  portion 
of  a  linear  Kalman  filter  to  estimate  target  offsets 
from  the  center  of  the  FOV.  The  linear  Kalman  filter 
processes  the  measurement  vector,  z(t^) ,  using 

x(ti+)  =  x(ti‘)  +  {z(t±)  -  Hx(t.’)}  (1-1) 

where 

x(t.+)  =  state  estimate  vector  after  measurement 
incorporation  at  time  t^ 

x(t.  )  =  state  estimate  vector  propagated  from 
*  previous  measurement  update  to  time  t^ 

K(t^)  =  Kalman  filter  gain 

z(t.)  =  measurement  vector  of  the  estimated  offset 
1  distance  in  the  horizontal  and  vertical 

direction  from  the  center  of  the  FLIR  plane 
to  the  centroid  of  the  intensity  function 

H(t.)  =  linear  combination  of  the  states  which 
1  contribute  to  the  respective  measurements 

A  detailed  development  of  the  Kalman  filter  equations  is 
given  in  Chapter  3.  These  estimated  offsets  are  to  be 
regulated  to  zero  by  using  the  estimates  as  inputs  to  a 
pointing  controller  that  points  the  laser  beam  and*  the 
center  of  the  FLIR  FOV  appropriately.  The  state  estimates 
are  also  used  to  aid  in  estimating  the  shape  function  in 
the  data  processing  algorithm. 

The  primary  focus  of  the  Rogers  thesis  was  to 
generate  an  accurate  estimate  of  the  target's  intensity 
shape  function  and  to  evaluate  its  performance  in  a  benign 
tracking  environment  where  the  target  did  not  leave 
the  FLIR  FOV  in  one  sample  period.  Thus,  a  four-state 
estimate  vector,  x(t^) ,  consisting  of  estimates  of  the 
x  and  y  positions  due  to  true  target  dynamics  and  the 
x  and  y  positions  due  to  atmospherics  was  utilized  (10) . 
The  position  estimates  are  along  the  FLIR  horizontal  and 
vertical  axes  respectively.  However,  in  order  to  track 
targets  over  a  wide  dynamic  range  the  capability  to 
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to  predict  future  target  position  is  required;  thus, 
in  this  research  the  four-state  estimate  vector  is  replaced 
by  an  eight-state  estimate  vector,  consisting  of 
estimates  of  the  target's  position  due  to  dynamics  and 
atmospherics  in  the  x  and  y  directions  as  well  as 
estimates  of  the  target's  velocity  and  acceleration 
in  both  the  x  and  y  directions . 

In  the  lower  path  of  Figure  1,  the  Kalman  filter 
incorporates  the  measurement  information,  using  Equation 
(1-1)  at  time  t^,  and  utilizes  its  internal  dynamics 
model  to  propagate  its  estimate  of  where  the  true  target 
position  will  be  at  the  next  sample  period,  t^+1,  using 

-(ti+l_)  =i(ti+l'  Vx(ti+)  (1-2) 

where 

^(t.+, ,t.)  =  filter  state  transition  matrix  as 
1  defined  in  Equation  (3-11) 

The  FLIR  is  located  so  as  to  zero  out  the  estimated 

target  dynamics  position  components  which  are  the  first 

two  states  of  x(ti+1  ) .  The  atmospheric  disturbances 

which  can  cause  apparent  translational  offsets  of  the 

intensity  function  on  the  FLIR  image  plane  are  also 

accounted  for  by  x(t^+^  )  and  the  correlator  template 

is  positioned  with  this  estimate.  The  incoming  measurement 

array  is  then  correlated  with  the  template  to  determine 

the  position  offset  between  the  two  arrays.  Errors  in 

the  correlation  algorithm  are  reduced  by  processing  the 

position  offset  estimates  with  the  Kalman  filter  which 

exploits  statistical  knowledge  of  the  correlator  errors 

to  produce  a  better  position  estimate  for  actual 

tracking  purposes  (9:13-14).  The  Kalman  filter  then  uses 

its  internal  dynamics  model  to  propagate  its  best 

estimate  of  the  states  at  the  next  sample  time,  x(t^+2^ • 

The  upper  path  of  Figure  1  is  designed  to  generate 
the  template  for  correlation  with  the  incoming  FLIR 
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data  array.  The  fundamental  concept  of  the  algorithm 

is  to  utilize  the  fact  that  the  actual  target  image 

will  change  rather  slowly  relative  to  a  given  sample 

period  while  background  noises  will  typically  change 

more  rapidly.  This  path  generates  an  estimated  representation 

of  the  average  value  of  the  target  intensity  pattern 

over  each  pixel,  which  wohld  be  observed  if  the  measurements 

were  noise-free  and  the  filter  state  estimates  were 

perfect.  The  location  of  the  centroid  of  the  target 

intensity  pattern  is  the  sum  of  the  effects  caused  by 

true  target  dynamics  plus  apparent  translational  motion 

caused  by  atmospheric  disturbances .  In  the  x-direction 

the  centroid  of  the  target's  intensity  profile  is  defined 

by 

xcentroid  -  xdynamics  +  xatmospherics  (1-3) 

and  control  action  is  applied  to  zero  out  the  estimated 
dynamics'  and  similiarly  in  the  y-direction.  Thus, 
under  these  conditions  the  target's  intensity  profile 
will  bt  Zfset  from  the  center  of  the  FLIR  FOV  by  the 
predicted  atmospheric  states,  x  (t.”)  and  y  (t.~). 

a  X  a  1 

To  generate  the  estimated  target  intensity  pattern 
from  the  noise-corrupted  FLIR  data,  interframe  smoothing 
is  employed  to  attenuate  the  noise.  The  raw  FLIR  data 
is  put  through  an  FFT  to  allow  for  efficient  data 
processing  and  possible  spatial  frequency  filtering. 

In  order  to  center  the  target  in  the  original  spatial 
domain,  the  appropriate  negating  phase  shift  is  applied 
to  this  transformed  image.  The  offset  estimate  for  the 
frame  at  t±  Is  provided  by  *cmtola(tL*)  and  y  centroid 
(t^  )  based  on  Equation  (1-3)  as  obtained  from  the 
Kalman  filter.  The  phase  shift  is  computed  according  to 
the  shifting  property  of  the  two-dimensional  discrete 
Fourier  transform  (8:Equation  (2-7)  ),  with  the  output 
of  the  "Negating  Phase  Shift"  appearing  as  the  result 
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of  passing  a  centered  target  image  through  a  FFT. 

This  result  can  then  be  averaged  with  the  most 
recent  N  such  centered  and  transformed  data  frames  to 
attenuate  the  background  noise  and  accenuate  the  underlying 
target  pattern.  Instead  of  explicitly  storing  N  data 
sets,  finite-memory  averaging  is  approximated  by  using 
exponential  smoothing 

Gft^  =  aG^)  +  (1-ct)  G  (ti_1)  (1-4) 

where 

G(t^)  =  current  data  frame  value  of  G 

A 

G(t^)  *  current  estimate  of  G 

A 

G(t^_^)  =  previous  smoothed  estimates  of  G 
o  =  smoothing  parameter;  0<a<l 

Thus,  a  smaller  a  corresponds  to  a  longer  finite 
memory  being  approximated  as  appropriate  for  slowly 
changing  target  patterns  (9; 8-11). 

At  time  ti#  the  output  of  the  "Exponential  Smoothing 
of  Centered  Data"  block  is  a  representation  of  the  FFT 
of  the  estimated  target  intensity  pattern  corresponding 
to  a  centered  image.  This  pattern  is  then  evaluated 
using  x(t^+^~)  which,  due  to  the  previous  controller 
action,  corresponds  to  offsetting  this  FFT  by  the  phase 
shift  corresponding  to  the  atmospheric  state  components 
of  as  generated  by  the  Kalman  filter.  The 

intensity  function,  h(x(t^+^  ),  t^+^) ,  is  then  ready  for 
use  as  the  template  in  the  correlation  process  at  the 
next  sample  time  t^+^,  and  is  placed  in  a  one  period 
storage  location  awaiting  the  next  measurement.  Note 
the  previous  contents  of  this  location  which  corresponds 
to  the  estimated  intensity  function  generated  by  the 
smoothing  algorithm  at  t^_^,  was  used  as  the  template  at 
i.e.  ,  t^) ,  to  generate  xlt^*)  and  x(t^+1“)  . 

Depending  on  the  correlation  method  used,  the  correlation 


The  computer  simulation  developed  by  Captain  Rogers 
(8)  was  used  as  the  basic  computer  program  to  which 
changes  were  made  to  evaluate  the  performance  of  the 
correlator/Kalman  filter  in  realistic  tracking  environments. 
This  approach  required  that  realistic  target  trajectories 
be  incorporated  into  the  truth  model  in  place  of  the  benign 
target  trajectory  model  used  by  Rogers.  Additionally, 
a  model  was  developed  to  account  for  the  movement  of 
both  single  and  multiple  hot  spots  relative  to  the 
aircraft  center  of  mass  and  to  project  the  hot  spot  or  spots 
onto  the  FLIR  image  plane  for  measurement  data.  The 
four-state  Kalman  filter  used  by  Rogers  was  replaced  by 
the  eight-state  Kalman  filter  which  is  developed  in 
Chapter  3.  Finally,  based  on  a  literature  search  of 
available  correlation  methods,  alternative  correlation 
methods  were  selected  based  on  the  criteria  previously 
discussed,  for  evaluation  against  the  correlation  method 
used  by  Rogers,  see  Chapter  4.  As  a  result  of  this 
evaluation,  one  alternative  method,  along  with  the  method 
developed  by  Rogers,  was  implemented  in  cascade  with 
the  Kalman  filter. 

* 

The  truth  model,  Kalman  filter,  and  correlator  models 
were  incorporated  into  a  computer  simulation  for  a 
performance  analysis  using  a  Monte  Carlo  simulation. 
Additionally,  the  truth  model  changes  were  incorporated 
into  an  extended  Kalman  filter  developed  by  Harnly  and 
Jensen  (6)  to  track  only  single  hot  spot  targets  with 
intensity  functions  well  described  as  bivariate  Gaussian 
to  provide  a  benchmark  of  performance  for  the  proposed 
algorithm. 

1.4  Overview 

Chapters  II,  III,  and  IV,  discuss  in  detail  the 
mathematical  models  used  in  the  computer  simulation. 

Chapter  II  presents  the  truth  model  which  represents 


the  environment  from  which  measurements  are  taken. 

Chapter  III  describes  the  eight-state  linear  Kalman  filter 

used  in  the  computer  simulation.  Chapter  IV  presents  a 

mathematical  development  of  the  methods  of  correlation 

used  and  an  analysis  of  the  performance  of  these 

correlation  methods.  Chapter  V  presents  a  performance 

analysis  of  the  linear  correlator/Kalman  filter  and  the 

Harnly  and  Jensen  filter  against  targets  exhibiting  a 

wide  range  of  dynamic  profiles  and  both  single  and 

multiple  hot  spot  intensity  shapes  on  the  FLIR  image 

plane.  Chapter  VI  presents  the  conclusions  and  recommendations. 


II.  Truth  Model 


2.1  Introduction 

The  truth  model  is  the  best  mathematical  representation 
of  the  real  world  process  to  be  simulated  that  is  available 
to,  and  can  be  implemented  by,  the  researcher.  In  this 
study,  the  truth  model  portrays  the  motion  of  the  target, 
an  air-to-air  missile  or  a  multiple  engine  aircraft,  in 
inertial  space  and  the  intensity  function  emitted  by  the 
target  which  is  distorted  by  atmospheric  disturbances. 

The  resulting  infrared  image  is  then  projected  onto  the 
two-dimensional  FLIR  image  plane.  With  this  distorted 
target  intensity  pattern  projected  onto  the  FLIR  image 
plane,  spatially  correlated  and  temporally  uncorrelated 
noise  which  accounts  for  background  and  inherent  FLIR 
noises,  are  added  to  create  the  corrupted  measurement 
array,  £ (t^) ,  for  incorporation  by  the  eorrela tor/Kalman 
filter. 

This  chapter  outlines  the  truth  model  used  in  this 
study.  For  details  of  how  the  components  of  the  model 
were  developed,  consult  the  cited  references.  * 

2.2  Target  Model 

This  section  develops  the  equations  which  represent 
the  trajectory  of  the  target  being  tracked  in  inertial 
space  and  translates  that  into  motion  on  the  two-dimensional 
FLIR  image  plane,  which  is  represented  by  movement  of  the 
target  intensity  patttern  within  the  FLIR  field-of-view. 
Although  this  motion  consists  of  several  components, 
in  this  research  the  apparent  target  motion  due  to 
boresight  errors,  FLIR  system  vibrations,  etc.,  are 
assumed  to  be  negligible  compared  to  the  motion  due  to 
target  dynamics  and  atmospheric  jitter.  Thus,  the 
continuous  time  target  model  describes  the  apparent  target 
motion  due  to  actual  target  dynamics  and  atmospherics 
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by  means  of  differential  equations,  as  well  as  stochas¬ 
tically  to  represent  the  statistical  properties  of  the 
physical  processes  of  concern  and  to  account  for  the 
unmodeled  physical  effects. 

As  developed  by  Harnly  and  Jensen  (6) ,  the  continuous 
target  dynamics  model  accounts  for  the  true  location  of 
the  target  center  of  mass  on  the  two-dimensional  FLIR 
image  plane  in  the  horizontal  direction,  a,  and  in  the 
vertical  direction,  6.  A  deterministic  model  was  used 
to  provide  a  time  history  of  the  target  location  so 
that  specific  trajectories  could  be  generated  for  tracker 
evaluation  although  a  stochastic  model  could  be  used.  Thus, 


*3(t)  =  a(t)  =  horizontal  velocity 
*2(t)  =  B(t)  =  elevation  velocity 

*D(t)  =  u(t)  -  [a  ( t )  3  ( t jJ*1 


(2-1) 


While  a  target  trajectory  could  also  have  been  generated 
by  simply  reading  in  time  histories  of  a  and  0  ,  a 
deterministic  model  of  the  form  of  Equation  (2-1)  v^s 
selected  so  a  switch  from  the  deterministic  form  to  either 
a  first-order  Gauss-Markov  process,  a  Brownian  motion 
stochastic  process,  or  the  stun  of  a  deterministic  and 
stochastic  model  could  readily  be  implemented  if  desired. 
The  atmospheric  disturbances,  as  developed  by  Mercier 
(10),  were  modeled  as  third-order  Gauss-Markov  processes, 
described  by  the  output  of  a  shaping  filter  with  a 
frequency  domain  transfer  function  of 

^A  =  K(14 .14) (659. 5)2  ,  (2-2) 

w3  (S+14.14) (s+659.5) 

driven  by  a  unit  strength  white  Gaussian  noise  w^. 

A  duplicate  independent  model  is  used  to  generate  yA 
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in  the  vertical  FLIR  plane  direction.  Physically, 
this  corresponds  to  jitter  in  each  of  the  two  FLIR 
image  plane  coordinate  directions  being  modeled  as  the 
output  of  a  linear  third  order  system  driven  by  white 
Gaussian  noise,  developed  to  match  the  power  spectral 
density  characteristics  of  the  observed  physical  jitter 
phenomenon.  The  atmospheric  jitter  is  then  represented 
in  both  FLIR  plane  directions  by  a  stochastic  differential 
equation  of  the  form 


^(t)  =  FA(t)xA(t)+GA(t)wA(t)  (2-3) 

where 


xA(t)  =  six  atmospheric  noise  states 

F^Ct)  *  atmospheric  plant  matrix 

G^t)  =  atmospheric  noise  distribution  matrix 

w^t)  »  two-dimensional  vector  of  white  Gaussian 
noise  inputs  with  statistics: 

E{wft(t) >  =  0 


and 


* 

E{wA(t)wA(t+T)  }  =  QA ( t)  6  ( x ) 


After  augmenting  the  atmospheric  states  to  the  dynamic 
states.  Equations  (2-1)  and  (2-3) ,  and  writing  the  equations 
in  an  equivalent  discrete  time  form  (6) ,  the  solution  to 
the  discretized  truth  model  propagation  of  the  motion 
of  the  target  intensity  function  has  the  form 
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where 


3 


b 


H  0* 


P 


•I 


xft^) 


Sa<V 


W 


«  state  vector  of  the  two  dynamic  states  and 
six  atmospheric  states 

*  input  matrix  for  dynamics  =  £(t^+1, t^) B(t) dt 

=  piecewise  constant  function  (constant  between 
sample  times)  evaluated  at  the  interval. midpoint 
as  an  approximation  to  the  integral  of  a(t)  and 
B(t)  from  ti  to  t^+1.  Explicitly, 


W  “ 


ct  (t .  +  At) 
1  2 


3  (t .+  At) 
1  2 


At  =  t.^.-t. 
x+1  x 


wAd(ti)  =  discrete- time  white  Gaussian  noise  with  statistics: 


E{s*d(V> 


E{sAd(V!£d<V 


>  ■ 


and 


■  WV 


’  t/ti+14(ti+i,T)GR(T)ga(T)^(T)  ^(t1+1.T)dt 

where  c/QAd  represents  the  Cholesky  square  root  of  QAd , 
See  reference  (12)  for  development. 


n 


i _ 


17 


Thus, 


Et  ^S»d(ti»>  -  ° 


=  e*d5ij 


Explicitly,  the  state  transition  matrix  is 


iA4t  0 


sBAtit-BAt0 


5B4t  0 


iAAt  0 


iBSt4tSE4t 
0  iBAt 


The  three  by  three  submatrics  in  £(t^+^»t^)  are  ideAtical 
and  propagate  the  atmospheric  disturbances  in  azimuth  and 
elevation  with  poles  A  and  B  as  shown  in  Equation  (2-2)  . 


5d(ti>  * 


For  a  detailed  development  of  Equation  (2-4)  consult  ref.  6, 
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The  last  step  in  the  target  dynamics  model  is  to 
define  the  azimuth  velocity,  a(t) ,  and  elevation  velocity, 
g(t),  in  the  FLIR  image  plane.  To  simulate  this  motion, 
the  target  velocity  was  initially  calculated  in  an  inertial 
frame,  with  its  origin  at  the  center  of  the  FLIR  image 
plane,  and  then  projected  onto  the  two-dimensional  FLIR 
image  plane.  The  relationship  between  the  FLIR  frame  and 
inertial  frame  is  shown  in  Figure  3. 

y 


Figure  3.  Inertial  Coordinate  Frame 

The  geometry  involved  in  the  azimuth  direction^  is  as 
shown  in  Figure  4. 


x 


Figure  4.  Azimuth  Geometry 


From  Figure  4, 

2  (t) 

a(t)  «  tan  I 

Xj(t) 

and 

.  x  (t)  iT  (t) -zT(t)i  (t) 

a(t)  =  -i - - - - i - 

Zj(t)+Xj(t) 


Equation  (2-6)  yields  an  azimuth  velocity  in  radians/ 
sec  which  is  converted  to  FLIR  image  plane  units,  pixels/ 
sec,  by  dividing  a(t)  by  20x10  radians/pixel  (6:33). 

Similiarly,  Figure  5  shows  the  geometry  involved  in 
computing  the  elevation  velocity. 


(2-5) 


(2-6) 


Figure  5.  Elevation  Geometry 
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where 


r  =  range  =  {x2 (t) +y2 (t) +z2 (t)  I1* 

2  2  k 

=  horizontal  range  =  {Xj (t) +Zj (t) } 


From  Figure  5,  the  tangent  function  can  be  used  to 
find  3: 


3  =  tan  1  y(t) 
rh(t) 


(2-7) 


3(t)  =  rh(t)fI(t)-yI(t)ih(t) 


*  rh(t)$I(t)-yI(t)  - 


rh(t)+yl(t> 

'xjtfcJijftJ+Zjft)  ^(t) 


rh(t) 


(2-8) 


r2  (t) 


The  elevation  velocity  is  then  converted  to  pixels/sec  also. 

By  inserting  Equations  (2-6)  and  (2-8)  into  Eqyation 
(2-4) ,  deterministic  time  histories  for  the  truth  model 
propagation  can  be  generated  to  produce  the  desired 
trajectories  for  the  target. 


2.3  Trajectory  Description 

A  thorough  evaluation  of  the  filter's  tracking 
performance  requires  that  specific  trajectories  be  designed 
to  test  the  ability  of  the  filter  to  maintain  an  accurate 
estimate  of  the  target's  true  position  under  various 
circumstances.  A  benign  crossing  trajectory  was  selected 
to  serve  as  the  baseline  for  the  filter's  performance, 
as  this  should  be  an  easy  trajectory  for  the  filter  to 
track.  For  the  multiple  hot  spot  case,  a  rolling 
trajectory  was  designed  to  evaluate  how  well  the  data 
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processing  algorithm  can  reconstruct  the  target  intensity 
pattern  when  the  target's  intensity  pattern  exhibits 
changes  on  the  FLIR  plane  relative  to  the  aircraft 
center  of  mass.  Several  trajectories  were  designed 
to  evaluate  the  filter's  ability  to  maintain  track  on 
a  target  performing  highly  dynamic  maneuvers.  Note, 
as  will  be  discussed  later,  under  these  circumstances 
while  the  center  of  the  target  intensity  pattern 
relative  to  the  aircraft  center  of  mass  does  not  change, 
the  orientation  of  the  elliptical  intensity  pattern  as 
projected  onto  the  FLIR  image  plane  will  change. 

Finally,  a  trajectory  was  designed  to  evaluate  the  ability 
of  the  algorithm  to  estimate  the  target  position  when 
the  target  is  performing  a  high-g  maneuver  and  the  dynamic 
shape  of  the  intensity  pattern  is  also  changing 
simultaneously. 

The  benign  trajectory  which  served  as  the  baseline 
for  filter  performance  was  simulated  by  having  the  target 
fly  a  cross-range  trajectory  parallel  to  the  x-y  plane. 

The  flight  path  referred  to  as  trajectory  1,  is  depicted 
in  Figure  6. 


(NOT  USED) 
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Figure  6.  Trajectory  1 

The  inertial  location  of  the  target  at  tQ  is  ? 

xl(t0)  =  5000.0  m 
yi(tQ)  =  500.0  m 
Zi(tQ)  =  20000.0  ra 

The  trajectory  throughout  the  simulation  is  given  by 

ij (t)  =  -1000.  m/sec 
£j(t)  =  0.  m/sec 
iT(t)  =  0.  m/sec 


Trajectory  1  was  used  to  evaluate  the  performance 
of  the  filter  against  a  multiple  hot  spot  target  flying 
either  a  wings  level  trajectory  or  a  roll  maneuver. 

Roll  rates  of  .5  radians/sec  and  1.0  radians/sec  were 
used  as  being  representative  of  realistic  performance. 

To  evaluate  the  performance  of  the  filter  against 
a  target  performing  a  maneuver,  the  target  was  initialized 
with  the  same  inertial  location  and  velocity  as  shown  in 
Figure  6.  Two  seconds  into  the  simulation,  a  constant  g 
pullup  maneuver  was  initiated  which  lasted  for  three 
seconds,  and  the  simulation  was  terminated.  The  flight 
path,  trajectory  2,  is  depicted  in  Figure  7. 
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Figure  7.  Trajectory  2 


The  trajectory  prior  to  the  pull-up  manuever  is  desc  bed 
by 

*z(t)  =  -1000  m/sec 

yj(t)  =  0. 

zz(t)  =  0. 

and  is  initiated  at  inertial  coordinates 

Xi(tQ)  =  5000  m 

yi(t0)  =  500  m 
z-^tg)  =  20000  m 

At  tz=2.0  sec,  the  pull-up  maneuver  is  initiated  at  the 
inertial  coordinates 

xz(t2)  =  3000  m 

yz  Cfc2^  =  500  m 

zI(t2)  =  20000  m  4 

The  velocity  equations  are  then 

4j(t)  =  -1000  cos{w(t-2) }m/sec 
£j(t)  *  1000  sin{w(t-2) }m/sec 
4z(t)  =  0.  m/sec 

and  the  inertial  position  of  the  target  can  be  determined  by 

Xj(t)  =  xI(t0)-2000-{1000/oj}sin{aj(t-2)  }  m 
Yjft)  =  yz (tQ)  +{1000/w}{l-cos  to (t-2) }  m 


z z ( t)  *  20000  m 


The  trajectory  2  equation  can  be  modified  so  that 
instead  of  the  target  performing  a  pull-up  maneuver 
in  the  inertial  y-direction  the  target  motion  is  in  the 
negative  inertial  z-direction.  In  this  case,  the  target 
turns  in  toward  the  FLIR  image  plane,  and  three  distinct 
ellipsoidal  intensity  patterns  are  projected  onto  the 
FLIR  plane.  With  the  x  equations  being  as  previously 
described,  the  motion  of  the  target  is  defined  by: 

^(t)  =  0.0  m/sec 

Zj(t)  =  -1000.0  sin{ui(t-2)}  ra/sec 

The  inertial  position  is  given  by: 


y^t)  =  500.0  m 

zI(t)  =  zi  (tQ) -{1000/w}  {1-cos  a)  (t-2)  }  m 

a)  is  set  at  various  constant  values  in  different 
simulations,  to  evaluate  the  performance  of  the  tracker 
against  targets  exhibiting  varying  degrees  of  maneuverability. 
In  this  research,  the . performance  of  the  tracker  against 
targets  performing  2  and  5  g  turns  was  eva3”ated. 

(u>  =  0.0196  and  0.049  radians/sec  respectively)  .  Note  that 
this  trajectory  represents  a  step  change  to  a  constant  g 
maneuver.  Although  realistically  such  changes  do  not  occur, 
for  ease  of  implementation  this  method  was  used.  However, 
this  also  implies  that  the  filter  is  being  required  to  track 
a  harsher  maneuver  than  the  more  realistic  pull-up 
maneuver,  in  which  w  builds  up  smoothly  from  zero  to  a 
constant  rate,  and  thus  better  performance  should  be  achieved 
in  the  more  realistic  environment. 

Trajectory  3  was  motivated  by  the  desire  to  evaluate 
not  only  how  the  filter  responds  when  the  target  being 
tracked  initiates  a  maneuver,  but  also  how  the  filter 
responds  when  the  target  terminates  the  maneuver. 


Trajectory  3  is  initially  the  same  as  trajectory  2, 
with  a  two-g  pull-up  maneuver  being  initiated  at 
t  =  2.0  sec.  With  this  maneuver  the  target  has  an 
inertial  velocity  at  t  =  3.5  sec  of 

*j(t  =  3.5)  =  -999.58  m/sec 
?1(t  *  3.5)  «  29.069  m/sec 
2j(t  =  3.5)  =  0.  m/sec 

The  target  terminates  the  pull-up  maneuver  at  t  =  3.5 
sec  and  continues  at  this  constant  velocity  for  the 
remainder  of  the  simulation. 

The  final  trajectory/  trajectory  4,  was  designed 
as  the  most  realistic  trajectory,  and  also  to  evaluate 
the  performance  of  the  filter  when  the  dynamic  shape 
of  the  target  intensity  pattern  is  changing.  Trajectory 
4  is  initialized  identically  to  trajectory  2.  However, 
at  t  »  2  sec,  a  two-g  turn  is  initiated,  with  the  target 
turning  toward  the  FLIR  plane  displaying  motion  in  all 
inertial  directions  (see  Figure  8) . 
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Figure  8.  Trajectory  4. 


This  maneuver  can  be  derived  by  the  two  coordinate  system 
transformations  shown  in  Figure  9. 


Xj(t)  =  -v{cos  a)(t-2)}  m/sec 


yj(t)  =  v{cos  w(t-2)}sin  w(t-2)  m/sec 
Zj(t)  =  -v{sin^  oj(t-2)}  m/sec 

and  the  inertial  target  position  is: 

Xj(t)  =  x].(t0)-2000-{  (1000/u>)  (sin  u)(t-2)} 

yT(t)  =  y_ (tn) +f (1000)  (sin2a) (t-2) )  } 

1  u  2u 

z  (t)  =  z^(Q-1000{  (t-2)  -1  sin  (2o>  (t-2) )  } 
1  0  2  4oj 

where  in  this  simulation  v  =  -1000  m/sec.  The  out-of¬ 
plane  angle  associated  with  this  maneuver  can  be  found 
by 

op  angle  =  tan  1  Zj(t) 

y^ftT 

2.4  Measurement  Model 

# 

With  the  motion  of  the  target  defined,  the  next 
step  is  to  define  the  intensity  function  generated  by 
the  target  and  project  that  function  onto  the  FLIR 
image  plane.  For  distant  targets,  the  intensity 
pattern  projection  onto  the  FLIR  image  plane  is  well 
approximated  by  a  bivariate  Gaussian  function  with 
circular  equal  intensity  contours  (5:223).  However, 
for  closer  range  targets,  Harnly  and  Jensen,  ref  6, 
found  an  elliptically  shaped  pattern  was  a  better 
representation  of  the  true  intensity  pattern.  This 
intensity  function  is 


where  the  variables,  as  shown  in  Figure  10,  are 


xpeak' 

a 


ImaX  =  maximum  target  intensity 


y 


peak 


coordinates  of  peak  intensity  function 


v,  OpV  =  eigenvalues  of  P?  cooresponding  to  the 

ellipse  semimajor  axis  along  the  velocity 
vector  and  the  semiminor  axis  perpendicular 
to  the  velocity  vector  respectively. 


v 

O.L0S 


velocity  component  of  the  target  perpendicular 
to  the  line  of  sight  from  the  FLIR  image 
plane  to  the  target 


0 


=  orientation  angle  of  v^LOs  the  FLIR 
plane,  aligned  with  the  semimajor  axis  of 


Figure  10.  Image  Intensity  Characteristics 


For  this  research,  a  pixel  dimension  of  20  y  rads 
is  used.  The  movement  of  the  point  of  maximum  intensity 
on  the  FLIR  image  plane  defined  by  xpeaJc  and  ypeafc  is 
determined  by  a(t)  and  g(t),  expressed  in  y  rads, 
respectively  after  the  effects  of  tracker  controller 
action  have  been  accounted  for.  Therefore,  the  8x8  FLIR 
FOV  will  be  160  y  rads  wide  in  azimuth  and  160  y  rads 
wide  in  elevation.  Because  of  this  small  FOV,  angular 
displacement  of  the  target  from  the  FLIR  FOV  can  be 
approximated  by  linear  displacement  on  the  FLIR  image 
plane.  Similiarly,  angular  velocity  closely  approximates 
linear  velocity  in  the  FLIR  image  plane  (6:24).  Thus, 
angular  measurements  were  used. 


The  intensity  pattern  on  the  FLIR  image  plane  is 
produced  in  several  steps.  From  the  simulation  of  the 
inertial  position  and  velocity  of  the  missile,  the 
azimuth  velocity  (x  velocity  in  Figure  11) ,  elevation 
velocity  (y  velocity  in  Figure  11),  and  speed  (the 
magnitude  of  the  velocity  vector  in  inertial  space) , 
were  computed  in  rad/sec.  The  azimuth  and  elevation 


velocity  then  define  the  missile  velocity  component 
perpendicular  to  the  line  of  sight,  v  ,  and  the 
ratio  of  Vj^gg  and  speed  is  the  cosine  of  the  out 
of  place  angle,  y.  Figure  11  shows  the  geometry 


involved  (6:24).  Explicitly,  the  relationships  are: 


cos  0  «'  a  (t) 


|vJ.L0s| 


to  target 

Figure  11.  Image  Projection 


With  cos  y  determined,  the  semimajor  axis  of  the 
missile  can  be  projected  onto  the  FLIR  image  plane. 
Referring  to  Figure  12,  where  <5  is  the  length  of  the 


semimajor  axis  in  meters,  the  length  of  the  semimajor  axis 
parallel  to  the  FLIR  plane  is: 


5  cos  y  m 


By  approximating  linear  distance  on  the  FLIR  plane 
as  the  angular  displacement,  this  distance  can  be  expressed 
as 


Op  =  i|>/.  00002  pixels 


(2-10) 


where 


r 


.00002  =  conversion  factor  from  radians  to  pixels 

Y 


Figure  12.  Semimajor  Axis  Projection 
To  make  use  of  information  already  computed  in  the 


ff1 


simulation  and  with  cos  y  =  1  at  t  =  0  for  the  trajectories 
used.  Equation  (2-10)  becomes 


where 


av  =  (cos  y) (avI) (rz)  pixels  (2-11) 

r 


r  =  initial  target  range 
avI  =  initial  length  of  semimajor  axis  in  pixels 

The  radius  of  the  circular  missile  IR  cross-section  is 
retained  as  the  semiminor  axis  and  similiar  to  the 
development  of  Equation  (2-11)  the  distance  on  the  FLIR 
image  plane  is  given  by 

apv  =  (qpvl) (rl}  Pixels  <2-12> 

r 

where 


apvl 


initial  length  of  seraiminor  axis  in  pixels 


* 

With  these  parameters  established,  the  intensity  at 
any  point  in  the  image  plane  can  be  computed.  This 
calculation  is  performed  in  the  image  ellipse  coordinate 
system.  The  intensity  function  is  then  (6:27) 


I(x,y) 


where 


I 

max 


exp 


r 

-0, 


5  [AxAyJ 


Ax 

Ay 


(x-xpeak)  cos  9  +(y-ypeak’ 


'y-ypeak'  cos  9  -(x-xpeak) 


sin  6 

sin  0 


(2-13) 
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8  =  rotation  angle  between  FLIR  axis  and  image 
ellipse  coordinate  axis 


The  average  intensity  for  any  pixel,  as  measured 
by  the  FLIR,  is  the  integral  of  the  apparent  target 
intensity  function  over  the  pixel  area  divided  by  the  area 
of  the  pixel,  corrupted  by  FLIR  and  background  noise. 

To  approximate  this  integral,  the  intensity  function  was 
averaged  over  twenty  five  equally  spaced  points  within 
each  pixel.  To  complete  the  simulation,  noise  corresponding 
to  FLIR  and  background  noise  was  added  to  each  pixel. 

For  one  of  the  64  pixels  in  the  1-th  row  and  m-th  column 
the  average  intensity  as  measured  by  the  FLIR  is 
repesented  as: 


5  5 

1 

25  k=l  j=l 


I 

max 


exp  J 


-0.5 


+  nlm(ti> 


(2-14) 


The  noise  term,  nlm(t^)  >  is  based  on  the  research  ^>f 
Harnly  and  Jensen,  ref  6,  who  documented  the  existence 
of  spatial  correlations  of  background  noise  in  each 
data  frame  with  nonnegligible  spatial  correlations 
between  each  pixel  and  its  closest  two  neighboring 
pixels  in  each  direction  (6:19).  The  64  measurements 
are  first  arranged  into  a  vector.  Then,  the  covariance 
matrix,  "R",  for  the  zero-mean  white  Gaussian  noise, 
n,  consisting  of  components  seen  in  (2-14),  is  of 
dimension  64x64.  With  the  spatial  correlation  matrix,  R, 
known,  realizations  of  the  noise  vector  can  be  produced 
by  performing  a  Cholesky  square  root  decomposition  of  R 
and  post-multiplying  it  by  a  vector  of  independent, 
white  Gaussian  noises,  each  of  zero  mean  and  variance 


of  one.  The  noise  vector  is 


v(t±)  =  G/g  v'(t.) 


(2-15) 


where 


v^(t.)  =  white  Gaussian  noise  vector  with  independent 
—  1 

scalar  noises  and  statistics 

E{v"(ti)>  =  0 
E{v"  (ti)v"T(tj)  }  *  I_6i j 

The  model  given  in  Equation  (2-15)  is  used  because  the 
noise  v'  is  readily  simulated  via  repeated  independent 
calls  to  a  Gaussian  random  number  generator.  Thus,  the 
covariance  of  v(t^)  is  equal  to  the  correlation  matrix. 

E{v(t  )vT(t  )}  =  e(C^5  v'(ti)v'T(t.)<VRT}  «  R6 

As  justified  in  the  analysis  by  Harnly  and  Jensen, 
temporal  correlation  of  the  background  and  FLIR  noises 
are  assumed  negligible.  The  noise  array  vector  is  ^hen 
added  to  the  input  array,  as  in  Equation  (2-14) ,  to  create 
the  measurement  array  for  the  correlator/Kalman  filter. 

Equation  (2-14)  represents  the  measurement  array  for 
a  single  hot  spot  target.  For  multiple  hot  spot  targets, 
three  Gaussian  hot  spots  with  elliptical  constant  intensity 
contours  and  parallel  semimajor  axes  were  used  in  this 
study.  The  measurement  is  then  the  summation  of  three 
double  summation  terms  of  the  form  given  in  (2-14) 
instead  of  one,  plus  the  noise  as  in  (2-14) . 

2.5  Projection  of  Multiple  Hot  Spots 


The  location  of  the  aircraft  center  of  mass  (COM) 


in  FLIR  coordinates  can  be  determined,  as  previously 
described,  and  the  method  for  projecting  the  intensity 
pattern  onto  the  FLIR  plane  is  the  same  for  multiple 
and  single  hot  spot  cases  because  the  assumption  is  made 
that  the  semimajor  axes  of  the  ellipsoids  are  parallel. 
Thus,  by  calculating  the  angular  orientation  of  one  of 
the  hot  spots  the  orientation  of  all  of  the  hot  spots 
is  known.  Therefore,  the  only  remaining  information 
required  for  the  projection  is  the  coordinates  of  the 
center  of  each  ellipsoid  in  the  FLIR  image  plane. 

This  requires  that  the  distance  from  the  COM  of  the 
aircraft  to  the  center  of  each  ellipsoid  be  known  in 
inertial  frame  coordinates  and  transformed  into  FLIR 
frame  coordinates.  For  single  hot  spot  targets,  the 
center  of  the  intensity  ellipsoid  is  assumed  to  coincide 
with  the  aircraft  COM  and  no  additional  calculations 
are  required. 

With  the  orientation  of  the  FLIR  image  plane 

relative  to  an  inertial  frame  being  as  shown  in  Figure 

13,  and  the  angles  a  and  $  known,  as  calculated  in  the 

trajectory  model,  unit  vectors  in  the  directions  referred 

to  as  ea  and  e  „  can  be  determined.  Notice  that  iA  FLIR 
p  za 

frame  coordinates  =  ty  FLIR  and  =  -ex  pLIR.  This 
coordinate  frame  was  selected  instead  of  using  FLIR 
directly  for  ease  in  implementing  the  required  coordinate 
frame  transformations  (Appendix  A) . 

The  eQ-e„„  plane  is  then  translated  in  inertial 
p  za 

space  so  that  the  origin  of  this  plane  coincides  with 
the  aircraft  COM  (Figure  14). 

From  the  trajectory  model,  the  velocity  vector  of 
the  aircraft  is  known.  Since  the  location  of  the  hot 
spots  in  a  body  fixed  frame  can  be  readily  determined, 
the  velocity  vector,  which  by  assumption  will  always 
point  out  the  nose  of  the  aircraft,  can  be  used  to  define 


one  axis  of  a  coordinate  frame  with  its  origin  lying 

at  the  aircraft  COM,  referred  to  as  the  H-frame.  Thus, 

eHx  is  defined  to  be  a  unit  vector  in  the  direction  of 

the  velocity  vector  and  forms  one  axis  of  the  H-frame. 

Performing  a  cross-product  of  the  velocity  vector  with 

a  unit  vector  in  the  inertial  y  direction,  "3,  will 

produce  a  vector  normal  to  ^  and  v,  which  is  normalized 

to  form  a  unit  in  the  direction  of  the  second  axis  of 

the  H-frame,  *e„  .  Note  that  this  axis  will  always  lie 
Hy 

in  the  horizontal  plane.  The  third  axis  of  the  H-frame 

is  subsequently  calculated  by  crossing  the  two  H-frame 

axis  vectors,  to  produce  a  vector  normal  to  the  e^-e^ 

plane,  which  when  normalized  becomes  e^.  The  unit  vectors 

of  the  translated  frame  and  the  H-frame  with 

p  zot 

origins  located  at  the  aircraft  COM,  are  shown  in  Figure  15. 


z  Hz 


Figure  15.  £0-e  and  H-Frame  Unit  Vectors 
p  zot 


Let  the  body  frame,  B,  have  the  x-axis  out  the 
aircraft  nose,  the  y-axis  out  the  aircraft  right  wing, 
and  the  z-axis  out  the  aircraft  belly,  and  assume 
that  initially  the  aircraft  is  oriented  such  that  the 
aircraft  body  frame  lies  with  the  plane  of  the  aircraft 
wings  in  the  e„  -e„  plane.  Specif icaJJLy  for  the  three 
hot  spot  target  model  used,  the  initial  location  of  the 
intensity  functions  are  shown  in  Figure  16. 
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Figure  16.  Initial  Ellipsoidal  Centers 

where 

®Hz'  ®Sz  into  the  page 

©-©  ,  and  ,  location  of  the  center  of  each 
intensity  ellipsoid,  in  relation  to  the  aircraft  COM. 

* 

By  assumption,  the  center  of  ellipsoid  1  will 


lie  along  the  e„  axis.  The  ellipsoidal  centers  along 
the  e^  axis  will  remain  along  that  axis  unless  the 
aircraft  performs  a  roll  maneuver,  in  which  case  their 
location  can  be  determined  as  shown  in  Figure  17.  In 
order  to  simulate  a  roll  maneuver  in  this  thesis,  a 
constant  roll-rate,  to,  was  used.  Using  a  constant 


roll-rate  implies  a  step  change  from  a  wing-level 
trajectory  to  a  constant  roll-rate  rather  than  a  smooth 
build  up  to  the  desired  rate.  This  method  was  used  for 
ease  in  implementing  the  simulation.  However,  this  also 
requires  the  filter  to  track  a  maneuver  which  is  harsher 
than  realis'cically  would  be  encountered  and  thus  the 
results  obtained  are  for  a  worst  case  scenario. 


e„  ,e0  (out  of  the  aircraft  nose) 
Hx  Bx 


Figure  17.  Roll  Maneuver  Geometry 


Since  the  intensity  f unci ton  centroids  are  offset 
in  the  egx-eBy  plane,  the  only  calculation  required  to 
determine  the  direction  of  the  ellipsoidal  centers  is 

®By  *  cos  ®Hy  +  Sin  *  ®Hz  (2-16) 


where 


<J>  is  the  roll  angle  measured  from  e„  to  e0  .  In 

riy  By 

simulations  for  this  thesis,  <j>  is  the  result  of  a 
constant  roll  rate  ui,  <p  =  cut 

Thus,  the  location  of  the  three  hot  spots  relative  to  the 
H-frame  can  always  be  determined. 

The  final  step  is  to  convert  this  distance  to  the 
equivalent  offset  distance  on  the  FLIR  image  plane. 

Let  <5  represent  the  distance  in  meters  from  the  aircraft 
COM  to  the  center  of  ellipsoid  2,  lying  in  the  positive 
eBy  direction.  This  is  depicted  in  Figure  18. 
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in  meters 


5zaT  =  ^eBy’ez^  38  distance  along  translated 

e  axis  in  meters 
za 

With  6gT  and  <5zaT  known/  this  distance  is  converted 
into  distance  on  the  FLIR  image  plane.  Since  the 
translated  e~-e  plane  is  normal  to  the  range  vector, 

P  Z  L* 

the  angular  displacement  of  the  hot  spot  from  the  center 

of  the  FLIR  FOV  can  be  used  to  approximate  the  linear 

displacement  in  the  FLIR  plane.  In  the  eD  direction, 

p 

=  tan  0*8*.  4^  (2-17) 

_____ 

where 


0  =  displacement  angle  as  shown  in  Figure  19. 
r  *  range 


Equation  (2-17)  gives  the  distance,  6^,  in  radians,  which 

is  converted  to  pixels  by  dividing  by  .00002  radians/pixel. 

Displacement  in  the  e^  direction  is  added  in  the  yFLIR 

direction  to  the  coordinates  of  the  aircraft  COM  to 

determine  the  yFLIR  location  of  the  hot  spot.  Displacement 

in  the  e„„  direction  is  likewise  calculated  and  subtracted 
za 

from  the  coordinates  of  the  aircraft  COM  to  determine  the 
XpLiR  location  of  the  hot  spot  because  of  the  axis 
orientation  shown  in  Figure  13.  Thus,  the  coordinates 
of  the  ellipsoidal  centers  in  the  FLIR  image  plane  are 
known.  To  demonstrate  this  projection,  a  sample  trajectory 
was  run  with  initial  coordinates 


Xj  =  yx  =  Zj  =  10,000  m 
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(.2-19) 


and  constant  velocity 

Xj(t)  -  YjCtl  -  z^t)  =  -5QQ*°  m/sec 

The  target  is  moving  directly  at  the  FLIR  image  plane 
therefore, 

a  (t)  =  6(t)  =0 

for  the  entire  trajectory.  Hot  spots  were  initially 
positioned  1  meter  forward  of  the  aircraft  COM  in  the 
e„  direction  and  (±)  .5  meters  in  the  e„  direction. 

nX  Hy 

Two  simulations  were  used  to  demonstrate  this  projection 
model.  The  first  run,  see  Figure  20,  shows  that  for  a 
roll  of  ir  radians,  hot  spot  1  stays  centered  in  the 
®0~®za  Plane»  while  hot  spots  2  and  3  roll  through  ir 
radians  and  remain  positioned  ir  radians  apart  on  the 
®3~^za  Plane*  As  the  aircraft  approaches  the  tracker 
location,  the  distance  from  the  aircraft  COM  to  the  hot 
spots  as  projected  onto  the  FLIR  plane  will  increase 
which  accounts  for  the  offset  semicircles  seen  in  Figure  20. 
The  second  run  also  initialized  as  in  (2-18)  with  velocity 
components  as  in  (2-19) ,  was  used  to  show  the  proper 
displacement  on  the  eft-e  plane.  During  this  run,  shown 
in  Figure  21,  the  aircraft  conducted  a  2  ir  roll  about 
its  velocity  vector  with  the  hot  spots  positioned  as  in 
the  first  run.  Substituting  the  initial  conditions  from 
Equation  (2-18)  into  Equation  (2-17)  yields  the  initial 
offset  distance  for  hot  spots  2  and  3  from  the  aircraft  COM. 

m  f  (±>  <-5>  lT  1  Is  (±>.1.44  pixels 

[{(3)  (10000^)  >^J|_.00002j 

For  a  5  second  simulation  Equation  (2-19)  can  also  be 
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used  to  determine  the  inertial  position  of  the  aircraft 
at  t  =  5.0.  Thus,  Equation  (2-17)  can  again  be  used  to 
determine  final  offsets  of  the  hot  spots. 

-r  (i)  ( ♦  5)  ,1  f  1  1  =  (±)  1.93  pixels 

Za  ^{(3)  (7500^)}^]  [_.00002J 

As  shown  in  Figure  21,  hot  spots  2  and  3  roll  through 
2  7t  radians  with  initial  and  final  offset  distance  as 
calculated  and  hot  spot  1  remains  centered  in  the  plane. 
For  a  detailed  description  of  the  projection  model 
equations,  see  Appendix  A. 
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III.  Kalman  Filter 


3.1  Introduction 

The  primary  focus  of  Rogers'  thesis  (8)  was  to 
develop  an  algorithm  capable  of  indentifying,  in  real¬ 
time,  the  intensity  function  of  the  target.  As  such, 
the  ability  of  the  Kalman  filter  to  track  a  realistic, 
highly  dynamic  target  was  not  of  primary  concern,  so  a 
four-state  Kalman  filter,  consisting  of  estimates  for 
the  x  and  y  position  due  to  true  target  dynamics  and 
the  x  and  y  position  due  to  atmospherics,  which  sum 
together  to  form  the  apparent  target  centroid  location  as 

x  -  x  +  x  (3-1) 

centroid  dynamics  atmospherics 

and  similarly  in  the  y-direction,  was  used.  Such  a 
model  is  acceptable  if  the  target  is  not  highly  dynamic 
and  does  not  leave  the  FLIR  FOV  in  one  sample  period. 
However,  in  practical  applications  a  missile  can  travel 
many  times  the  width  of  the  FLIR  FOV  in  one  sample  period 
For  example,  a  typical  missile  at  a  range  of  10  km  can 
travel  approximately  80  pixels  per  sample  period  and  a 
FLIR  with  an  8x8  pixel  FOV  and  no  predictive  capability 
will  not  be  able  to  keep  the  target  within  its  FOV, 
resulting  in  loss  of  target  track  (6:69).  Therefore, 
the  tracker  must  have  a  predicted  target  position  for  the 
next  sample  period. 

Although  a  six-state  filter  which  additionally 
estimates  target  velocity  in  both  directions  might  be 
appropriate  in  certain  situations,  previous  research 
efforts  have  shown  that  in  order  to  achieve  accurate 
target  position  information  acceleration  estimates  in 
both  directions  must  be  incorporated  into  the  filter 
model  as  well,  resulting  in  an  eight-state  filter  (6) . 
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Of  the  acceleration  models  most  commonly  used,  first  order 
Gauss-Markov  and  constant  turn-rate  models  have  yielded 
the  best  results,  with  the  constant  turn-rate  model 
proving  more  representative  of  the  tracking  scenarios 
being  investigated  (7,16).  However,  the  performance 
enhancement  achieved  by  using  the  non-linear  constant 
turn-rate  model  is  not  so  significant  as  to  justify 
the  increased  computational  burden  associated  with  its 
implementation  over  the  linear  Gauss-Markov  model  (11) . 
Therefore,  a  first-order  Gauss-Markov  acceleration 
model  was  selected  for  this  study.  As  in  Rogers' 
four-state  filter,  this  filter  uses  the  Gauss-Markov 
model  developed  by  Mercier  for  the  atmospheric  jitter 
process  (10) . 


3.2  Acceleration  and  Atmospheric  Models 

Target  acceleration  and  atmospheric  jitter  are 
modeled  as  stationary,  first-order  Gauss-Markov 
processes,  generated  as  the  outputs  of  first-order 
lags  driven  by  white  Gaussian  noises.  The  differential 
equation  describing  such  a  process  is  * 

x(t)  =  -  ix(t)  +  w ( t)  (3-2) 

and 

E{w(t)  }  =  0 

E{w(t) w(t+x) }  =  2a2  5(t) 

T 

where 

x(t)  =  the  Gauss-Markov  process  with  initial 
conditions  determined  from  a  priori 
knowledge  of  the  process 


T  -  correlation  time  of  x(t) 


w(t)  =  white  Gaussian  noise  process 
a  =  root  mean  square  value  of  x(t) 

Throughout  the  development  of  this  chapter,  the 
subscripts  a,  d,  and  f,  will  be  used  to  represent 
atmospherics,  dynamics,  and  filter,  respectively. 

For  the  atmospheric  position,  the  correlation  time 
constant,  T.^,  as  developed  by  Mercier  (10)  will  be 
used.  The  acceleration  time  constant,  Td£,  is  a 
parameter  to  be  established  during  the  off-line  filter 
tuning  process  although  on-time  estimation  techniques 
could  be  employed  (13: Chapter  10) .  Equation  (3-2) 
serves  as  the  stochastic  model  upon  which  the  filter 
is  based. 

3.3  State  Space  Model 

The  eight-state  filter  will  now  be  put  into 
state  space  notation.  The  dynamics  model  in  each 
direction  is  * 


*af(t)  *  vdf(t) 

*df(t)  *  ad£(t) 

£,f(t)  =  -  1  a  (t)+w.-(t) 
«  Tdf  df  d£ 


and 


E{wdf(t)}  =  0 

E{w (t) w. - (t+t) }  =  2o2  , -  6 (t) 


where 


T^£  =  correlation  time  assumed  for  target  acceleration 
=  assumed  target  acceleration  process  variance 
The  atmospheric  disturbance  model  in  each  direction  is 

*af(t>  -  -i  *af(t,+waf(t>  (3-4» 

1a  £ 


and 


L 

M  C* 

W 


E{Waf(t)}  =  0 


E{waf (t)waf (t+T) } 


2a2afS(x) 

Taf 


where 


Ta£  =  correlation  time  assumed  for  atmospheric 
jitter  4 

CTaf  ~  assumed  atmospheric  jitter  process  variance 

Augmenting  the  atmospheric  states  to  the  dynamic 
states,  the  propagation  equation  upon  which  the  Kalman 
filter  is  based  is  formed: 


xf(t)  =  Ff (t)xf (t) +Gf (t)wf (t)  (3-5) 


where 

F^(t)  =  time-invariant  filter  plant  matrix 
x^(t)  =*  filter  state  vector 


4 
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x^  =  azimuth  position 


x2  =  elevation  position 

x^  =  azimuth  velocity  =  x^ 

x4  =  elevation  velocity  =  *2 

x5  =  azimuth  acceleration  =  &3 

Xg  =  elevation  acceleration  -  *4 

x7  =  azimuth  atmospheric  disturbance 

Xg  =  elevation  atmospheric  disturbance 

— j  =  constant  8x4  noise  distribution  matrix 

wf(t)  =  4-dimensional  white  Gaussian  noise  composed 
of  w-^  =  wdfx  and  w2  =  as  in  (3-3)  and 

w3  -  wafx  and  w4  *  wftfy  as  in  (3-4) . 

Substituting  Equations  (3-3)  and  (3-4)  into  Equation 
(3-5)  yields: 


and 


2°y 


2od  £ 


a*  - 


2oaf 


2ok 


(3-7) 


3.4  State  Propagation 

The  Kalman  filter  must  propagate  its  state  estimate 
vector  and  conditional  covariance  matrix  from  one  sample 
time  to  the  next.  The  standard  propagation  equations 
for  the  case  of  zero  control  inputs  over  a  sample  interval 
are: 


-f(ti+l  }  -f ^i+l'^V-f {ti  * 


(3-8) 


where 


-f(ti+l  1  “  -f  ^i+l'^-f  (ti  )$f(ti+l,ti)  *  (3-9) 


+t/1+1  if(ti+1,T)Gf(T)Qf (T)G^(T)$^(ti+1,T)dT 


$^{t£+1,t^)  =  filter  state  transition  matrix 


Pf(ti  )  =  conditional  state  covariance  matrix 
from  measurement  update  at  time  t^ 


P^(t^+^~)  =  conditional  state  covariance  matrix 
propagated  from  time  t^  to  t^+^ 


*  noise  covariance  kernel  description 
as  defined  in  Equation  (3-7) 

The  filter  state  transition  matrix,  $£(t^+^,t^),  must 
satisfy  the  differential  equation 

$f(t,t^)  =  Ff$f(t,t..)  (3-10) 

over  the  interval  (ti^i+l*'  with  initial  condition 

-f(ti'fci)  *  i  (identity  matrix) 

In  this  application,  the  plant  matrix  Ff  is  constant 
and  the  fixed  sample  period  results  in  a  constant  state 
transition  matrix,  (t .+^,t^)  ,  for  all  sample  periods. 
Thus, 


(3-11) 


where 
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4t  = 


The  solution  to  the  integral  term  of  Equation  (3-9) , 
Qfd*  which  represents  the  growth  in  uncertainty  due  to 
dynamic  driving  noise  since  the  last  measurement  update 
becomes 


— fd 


W11 

0 

Q13 

0 

°15 
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Q77 

(3-12) 


where 


Q11  "  °df 


(2)  (Tdf)  (At)3  -(2)  (Tdf)2(At)2-(4)  (Tdf)3(At)  (i^-) 


df 


+  (2)«d£>3‘W-(Tdf)4(i^)+Ta£4 


°13  “  °df  [<Tdf>  <At)2M2>  (Td£)2(At)  (i|t_)+Td£3-(2)  <Tdf)3<5^ 


df 
3  >- 


-  (2) (Tdf)  (At)+(Tdf)  (e 


«£>] 


df 


df 


?15  *  °df 


[<-2>  <Td* 


>Wt)(i|^)+Tdf2-(Td£)2(i|^) 


] 
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to 


w  r* 


°33  * 


-  °If  [<2><Tdf,(4t)-<3»('rdf)2+(4)<Td£,2(Sf^)-<Tdf,2<i^7)] 


'35 


'55 


'77 


=  cr2 


=  a2 


frdf-(2)  (T,*)  (i^-)  +  (T 


df 


=  a2 


E-^] 

MS] 


df 


df 


df)  ( %f } 


) 


Note  that  Q22  -  Qjj/  Q44  -  Q33»  Qgg  -  Q55»  Q88  =  Q77 / 
Q24  =  Q13»  Q2g  *  Q15 »  Q46  =  Q35-  For  development  of 


the  noise  covariance  matrix.  Equation  (3-12) ,  see 
Appendix  B. 

The  matrix  of  Equation  (3-12)  is  constant  for  a 
given  sample  time  and  fixed  T^  and  Ta£.  The  values 
of  and  a2f  of  the  Equation  (3-7)  can  either  be 
determined  offline  during  a  filter  tuning  process  or 
adaptively  in  real-time  although  in  this  instance  a2f 
was  always  determined  offline.  This  tuning  process  is 
used  to  .select  the  values  of  these  parameters  which 
optimize  tracking  performance,  optimum  in  the  sense  that 
the  mean  square  tracking  errors  are  minimized,  for  specific 
scenarios.  Equations  (3-8)  and  (3-9)  propagate  the 
filter  states  and  conditional  covariance  forward  to  the 
next  sample  time.  Once  the  predicted  states  for  the  next 
sample  time  are  calculated,  the  estimates  of  the  target's 
position  in  azimuth  and  elevation  are  fed  back  to  the 
controller.  The  controller  then  positions  the  center  of 
the  FLIR  field-of-view  at  that  predicted  location  by  the 
next  sample  time.  Since  the  filter  assumes  that  the  FLIR 
is  centered  on  the  true  target  position,  the  state 
estimate  prior  to  the  measurement  update  is 


i+1 


') 


0 


0  0  x 


T 


velyvelxaccxatmosyatmosJ 


(3-13) 
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i.e.,  x(t^+^  )  of  Equation  (3-8)  with  the  first  two 
components  zeroed  out. 

3.5  Measurement  Update  Equation 


The  two-dimensional  discrete-time  measurement  vector 
generated  by  the  correlation  algorithm,  .z  (t^)  ,  is  a 
linear  combination  of  the  state  variables  of  interest, 
i.e.  the  apparent  target  intensity  function's  true  position 
corrupted  by  uncertain  measurement  disturbance,  v(t^) . 

Thus, 


z(t±)  =  Hfxf  (tj.J+Vf  (tj.) 


(3-14) 


where 


Hf(ti) 


=  the  estimated  x  and  y  coordinates  of  the 
centroid  of  the  target  intensity  function 
as  estimated  by  the  correlation  algorithm 


[1000001  ol 
0  1  0  0  0  0  0  ij 


=  linear  combination  of  the 

state  variables  which 

* 

contribute  to  the  measurement 
elements 


=  additive  noise  assumed  to  be  white  Gaussian 
with  statistics: 


The  measurement  information,  z (t^) ,  is  incorporated  by 
the  Kalman  filter  using  the  standard  update  equations: 


=  -f  (V-f  (ti")iif  (tj.J+Sf  <t±)  >-1 

£f(tt)  =  xf  (t^J+Kf  (t±)  {zf  (ti)-Hf  (t±)Sf  (t±")  } 

=  (3-15) 

where 

ftf <t±  )/Pf(t^  )  =  state  estimate  and  conditional 

covariance  obtained  from  Equations 
(3-8)  and  (3-9) 

Kf(t^)  =  Kalman  filter  gain 

Rf(t^)  »  measurement  uncertainty  covariance 
matrix  as  determined  from  a 
statistical  analysis  of  measurement 
errors  (see  Chapter  4)  and  assumed 
constant  for  off-line  tuning 

0* 

For  a  detailed  development  of  the  Kalman  filter  equations, 
see  reference  12. 

# 

3.6  Qq  Estimation 

Online  parameter  estimation  techniques  are  often  used 
to  improve  the  quality  of  the  state  estimates  when 
uncertain  parameters  exist  within  the  system  model  or 
noise  covariances.  Although  a  variety  of  estimation 
techniques  are  available  (13:  Chapter  10),  a  self-tuning 
adaptation  technique  was  chosen  since  all  of  the 
information  required  to  implement  this  estimator  is 
available  from  the  Kalman  filter  equations,  and  the 
computational  loading  incurred  by  implementing  this  method 
is  substantially  less  than  the  other  estimation  techniques 
referenced. 
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The  estimator  is  developed  as  follows: 


Pf(ti  )  -  if (ti-i  (ti»ti-i)+£fd*ti-l*  *3' 


and 


PfU/)  =  Pf  (t:")-Kf  (tL)Hf  (t±)Pf  (tL~)  (3-17) 

Solving  Equation  (3-16)  for  P(t^~)  yields 

Pf(t±“)  =  if (fci+>+Kf (t^Hf (t±)Pf (t.")  (3-18) 


where  the  Kf (t^)Hf (t^)Pf (t^  ),  term  is  preserved  intact 
because  it  will  be  estimated  on  the  basis  of  observed 
residuals.  Setting  Equation  (3-18)  equal  to  Equation 
(3-16)  and  solving  for  yields 


2fd<V  •  l'£<t1)H£(ti)Pf(ti-)+P£(ti  )-»£(t1,t1.1)  • 


*  >if  (ti/ fci-i^  (3-19) 


The  only  term  in  Equation  (3-19) not  readily  available 
from  the  filter  is  the  first  term.  To  obtain  this 
information,  rewrite  the  state  update  equation.  Equation 
(3-15) ,  as 

*f  (t±+)-xf  (t^)  =  Kf(ti)rf(ti)  =  Ax(tj.)  (3-20) 

T 

An  estimate  of  E{Ax(t^)Ax  (t^) }  may  be  obtained  by  invoking 
ergodicity  to  replace  the  ensemble  average  with  a  single 
sample  time  average: 

E{Ax(t.)AxT(t.) }  A  1  E  (Ax (t . ) AxT (t . ) }  (3-21) 

“  1  1  N  j=i-N+l  3  J 


Assuming  steady  state  filter  operation,  the  residual 
sequence,  Ax(t^) ,  can  be  shown  to  be  a  white  Gaussian 
sequence  with  zero  mean  and  covariance  Kf  (t^)H^(t^)Pf  (t^**) 
(12:229): 

1  T 

K- (t . ) H- (t . ) P  -  (t.  )=1  2  {Ax(t.)AxX(t.) >  (3-22) 

1  1  1  1  1  r  N  j=l-N+l  3  3 

Substituting  Equation  (3-22)  into  Equation  (3-19)  gives 

d ( fci )  as: 

Qf<a(t. )  =U  {Ax(t.)AxT(t.)}+P-(t.+) 

ta  1  N  j=l-N+l  3  3  r  1 

-*f<Vti-i)£f(ti-i+)if(ti'ti-x>  (3'23' 


However,  rather  than  averaging  over  just  the  first  term, 
this  can  be  approximated  by  averaging  the  entire  relation 
over  the  most  recent  N  sample  periods: 


Qfd(t 


J  =11  (Ax(t.)  xT(t,)}+P<r(t.+) 

1  N  j=i-N+l L  3  3=3 

~if  (tj,tj_1)Pf  (tj_x  )if  ^tj  ,  t^_x)J 


(3-24) 


This  can  also  be  viewed  an  an  approximated  maximum 
likelihood  estimate  of  to  be  achieved  simultaneously 
with  state  estimation  (13:Chapter  10). 

To  reduce  data  storage  requirements,  a  fading  memory 
approximation  to  finite  memory  averaging  was  employed 
(6:86) : 


where 


Qfdi(ti)  =  the  single  summation  term  in  (3-24) 
corresponding  to  time  tj  =  t^ 

a  =  a  parameter  which  essentially  controls 

how  long"  old  estimates  of  Qfd  are  maintained, 
i.e.,  the  length  of  the  effective  memory 
in  the  fading  memory 

In  Equation  (3-24) ,  setting  a  =  1  would  use  only  the 
old  an<*  lgnore  the  current  data,  while  setting 

a  =  0  would  result  in  ignoring  all  previous  Qfd  estimates. 
Therefore,  a  low  a  value  implies  that  little  useful 
information  is  believed  to  be  contained  in  the  previous 
estimates,  while  a  high  a  responds  slowly  to  current 
estimates.  Typical  values  for  a  are 

0.7<a<1.0 

Note  this  is  the  same  fading  memory  technique  employed 
in  the  "Exponential  Smoothing  of  Data"  algorithm  sl^own  in 
Equation  (1-4) . 
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XV.  Methods  of  Correlation 


4.1  Introduction 

The  extended  Kalman  filter  has  been  shown  to  perform 
well  in  comparison  to  standard  correlation  trackers  when 
the  filter  was  provided  valid  a  priori  information  about 
the  analytic  form  of  the  intensity  function  (8) . 

However,  without  this  a  priori  information  the  benefit 
of  implementing  a  high-dimensional  measurement  extended 
Kalman  filter  is  greatly  reduced.  Additionally,  the 
correlation  algorithm  is  computationally  easier  to 
implement.  Consequently,  this  section  explores  four 
correlation  methods  for  possible  implementation  as 
data  preprocessors  to  generate  a  two-dimensional  FLIR 
target  image  centroid  "measurement"  to  the  linear  Kalman 
filter  described  in  Chapter  3. 

The  correlator  in  this  tracking  system  is  used  to 
generate  estimates  of  position  within  a  noise-corrupted 
data  frame  using  the  estimated  intensity  function, 
h(5kf(t^  ),t^),  generated  by  the  data  processing  algorithm 
as  its  template.  The  template  has  been  positioned  with 
— f^fci  ^ '  as  ProPa9ated  by  the  Kalman  filter  from  time 
tj_^.  Additionally,  controller  action  is  taken  to  zero 
out  the  first  two  components  of  ^f(ti~),  i.e.  the  filter's 
estimation  of  where  the  true  target  dynamcis  will  place 
the  target  at  the  next  sample  time,  or 

*  (0  0  *vel  S’vel  *acc  *acc  *atmos  ^atmos}* 

where  the  components  are  evaluated  at  t^  .  The  incoming 
noise-corrupted  measurement  is  then  received  at  t^  and 
is  correlated  with  the  template  to  determine  the  point 
of  maximum  resemblance  between  the  two  data  arrays. 

The  distance  from  the  center  of  the  template  to  the  point 
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of  maximum  correlation,  as  estimated  by  the  correlation 
process,  in  the  x  and  y  FLIR  directions  can  be  considered 
as  an  indication  of  the  error  in  the  Kalman  filter's 
estimate,  ^(t^_),  of  the  target  position,  or  as  a 
pseudomeasurement  of  this  position.  Thus,  the  offset 
distances  in  the  xFLIR  and  yFLIR  directions  are  incorporated 
by  the  Kalman  filter  as  measurement  data  to  provide  a 
better  estimate,  &f(t^+),  of  the  true  target  position. 

The  filter  propagates  the  state  estimate  forward  to  the 
next  sample  time  and  the  template  is  repositioned  at 
that  location  with  5i*(t.L,-)  for  correlation  with  the 
next  measurement.  This  method  will  enhance  the  performance 
achieved  by  standard  correlation  trackers  because: 
a)  the  data  processing  algorithm,  which  provides  the 
correlation  template,  yields  a  better  representation 
of  the  target's  true  intensity  function  than  raw  data  used  by 
correlators,  b)  the  Kalman  filter  statistically  characterizes 
known  errors  in  the  correlation  process  to  provide  a 
better  estimate,  and  c)  the  Kalman  filter  exploits 
knowledge  of  target  dynamics  and  atmospherics  to  position 
the  template  for  incorporation  of  the  next  measurement, 
whereas  this  information  is  not  used  in  standard 
correlation  methods. 

In  this  chapter,  several  methods  of  computing  the 
correlation  between  the  two  data  arrays  are  considered 
and  a  performance  analysis  of  the  most  promising  methods 
is  detailed.  This  analysis  considers  the  performance 
of  the  correlation  algorithms  against  targets  exhibiting 
both  single  and  multiple  hot  spots. 


4.2  Image  Resolution 

A  fundamental  requirement  for  any  of  the  correlation 
methods  under  consideration  is  that  the  images  to  be 
correlated  must  have  the  same  spatial  resolution.  In 
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this  research,  these  two  images  are  the  8x8  FLIR 
tracking  window,  and  the  24x24  template  array.  The 
area  of  a  pixel  in  the  tracking  window  is  the  same  as 
the  area  of  a  pixel  in  the  template,  thus  the  two 
images  to  be  correlated  have  the  same  spatial  resolution, 
and  no  image  preprocessing  is  required.  The  24x24  template 
is  generated  by  the  data* processing  algorithm  (8),  which 
assumes  that  the  finite  data  array  is  one  period  of  an 
infinitely  periodic  two-dimensional  sequence.  Padding 
the  tracking  window  with  8  rows  and  columns  of  zeros 
creates  a  24x24  array  which  is  assumed  to  be  one  period 
by  the  Discrete  Fourier  Transform  (DFT) .  This  padding 
insures  that  the  infinite  periodicity  assumption  will 
not  affect  the  results  within  the  8x8  tracking  window. 

If  the  spread  parameter  of  the  intensity  pattern, a*, 
is  such  that  the  height  of  the  target  intensity  function 
is  approaching  zero  near  the  edge  of  the  tracking  window, 
then  padding  the  tracking  window  with  zeros  will  not 
adversely  affect  the  results  of  the  data  processing 
algorithm.  In  the  situation  where  a*  is  such  that 
significant  intensity  magnitudes  exist  outside  of  the 
8x8  array,  then  to  pad  with  zeros  would  introduce  4n 
artifical  edge  in  the  intensity  function.  Thus,  padding 
with  zeros  is  desired  when  possible  as  this  will 
accenuate  the  true  intensity  function  without  discarding 
useful  data.  However,  since  for  this  application  a 
full  FLIR  frame  consists  of  300x400  pixels,  the  8x8  data 
array  could  be  padded  with  noise  corrupted  data  when  the 
spread  parameter  of  the  target  intensity  function  is 
such  that  there  are  significant  intensity  magnitudes 
outside  of  the  8x8  tracking  window  (8:77-78)  . 

4.3  Correlation  Methods 

a.  Direct  Method .  The  direct  method  is  the  classical 


approach  to  determining  when  two  signals  match.  Consider 
the  two  functions  shown  in  Figure  22 . 


(4-2) 


C(p)  =  Tl  fr(t)f.(t+x) 
n=-°° 

where 

f,(t)  =  f.(t)  1 

I  t=nT 

f2(t)  =  f 2 ( t+T ) 

t=nT 

t=pT 

T  =  sample  time 


As  T  becomes  small,  the  result  of  Equation  (4-2) 
approaches  (4-1)  and  the  p  which  maximizes  C(p)  is  defined 
as  the  corelation  point.  With  the  two-images  to  be 
correlated  as  shown  in  Figure  23,  the  two-dimensional 
discrete  correlation  algorithm  is  (14:17-20): 


R(p,q)  -  1  B  f  G  <x,y)G  <x+p,y+q) 

KL  y=l  X=1J-  “2 

for 

0  1  P  1  X-K 
0  £  q  £  Y-L 


(4-3) 


* 


(Note:  In  this  instance  since  the  array  is  of  smaller 
dimension  than  the  array  negative  values  of  p  and  q 
are  not  required  which  corresponds  to  the  tracking  window 
being  of  smaller  dimension  than  the  template.) 

Since  in  this  research  the  8x8  tracking  window  is 
padded  either  with  zeros  or  noise  corrupted  data,  the 
corrdinates  of  the  pixels  in  the  tracking  window  to  be 
correlated  range  from  9-16  in  the  x  and  y  FLIR  directions. 
Equation  (4-3)  then  becomes  {14:20} 


=  8x8  tracking  window  within  padded  data  array 


G^  =>  24x24  template 
This  is  pictured  in  Figure  24, 


padded  FLIR 
.window  data 
array 


template 


tracking 

window 


Figure  24.  FLIR  and  Template  Arrays 


Equation  (4-4)  is  referred  to  as  the  direct  correlation 
method  (14-20) .  Notice  the  range  over  which  p  and  q  are 
allowed  to  vary.  A  total  correlation  of  the  two  arrays 


would  have  p  and  q  range  from  0  to  16.  However,  if  the 
target  intensity  function  is  outside  of  the  8x8  tracking 
window  no  useful  measurement  information  will  be 
contained  in  the  incoming  data,  and  the  tracker  is 
considered  to  have  lost  the  target  unless  the  size  of 
the  tracking  window  is  expanded  (a  possibility  not 
explored  in  this  research) .  Recall  that  the  template 
which  contains  the  estimated  intensity  function  offset 
by  the  atmospheric  states  is  generated  via  the  data 
processing  algorithm  from  the  measurement  arrays  which 
have  been  padded  with  8  rows  and  columns  of  either  zeros 
or  noise-corrupted  data.  Therefore,  to  perform  a 
correlation  outside  of  the  p  and  q  region  shown  is 
equivalent  to  correlating  the  incoming  data  array  with 
either  zeros  or  smoothed  noise.  In  either  case,  a 
correlation  match  in  this  area  indicates  the  incoming 
array  contains  no  useful  information,  i.e.  target 
track  has  been  lost.  For  this  reason,  correlation  in 
the  region  outside  of  the  chosen  p  and  q  bounds  was  not 
performed,  thereby  reducing  the  computational  loading  of 
the  algorithm. 

Equation  (4-4)  can  be  normalized  so  that  the  * 
calculation  of  correlation  points  is  insensitive  to 
magnitude  values  and  depends  solely  on  the  pattern  of  the 
8x8  arrays  within  the  template  (14:20).  The  normalized 
correlation  function,  RN(p,q)  is: 


8  8 

RN(p,q)  =  2  2  G^x+S^+SjGjtx+p^+q) 

y— 1  x  1 


(4 


“8  8,  IT8  8  2  1 

2  2  G7 (x+8 ,y+8)  2  2  G  (x+p,y+q) 

_y=l  x=l  1  J  |_y=l  x=l  2  J 


for 


4  <  p  <  12 
4  <  q  <  12 


Thus,  Equation  (4-5)  defines  the  normalized  direct 
correlation  method  implemented  in  this  research. 

Actual  implementation  of  Equation  (4-5)  requires 
the  signals  of  template  and  the  FLIR  data  be  digitized. 
The  process  of  digitizing  a  continuous  signal  consists 
of  two  distinct  steps.  The  first  is  the  sampling  of 
the  signal  at  discrete  intervals,  the  second  is 
quantization.  The  truth  model  provides  the  sampled 
signal  in  this  instance.  Two  separate  quantizers  were 
implemented  to  evaluate  the  merits  of  using  a  low-level 
quantizer  which  is  readily  implemented  versus  the 
performance  enhancement  achieved  by  using  a  higher- level 
quantizer,  with  its  associated  increased  computational 
burden.  The  input-output  relationship  for  the  two 
quantizers  chosen  is  shown  in  Figure  25. 


Figure  25.  Input-Output  Relationships 
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For  the  two-level  quantizer/  a  pixel  within  the  array 
is  assigned  a  value  of  +1  if  the  intensity  for  that  pixel 
is  above  the  mean  intensity  level,  and  the  pixel  is 
assigned  a  value  of  -1  if  the  signal  is  below  the  mean 
intensity  level.  The  mean  intensity  values,  and  G2(p,q) 
are  determined  by: 

8  8 

G,  -  1  E  I  G, (x+8#y+8) 

1  rmsr  y=i  x=i  1 

8  8 

^2^'^  =  1  £  E  G_  (x+p,y+q) 

(6) (8)  y=l  x— 1  2 

Thus,  Equation  (4-5)  becomes  (14:32) 

8  8 

Rjg  (P»q)  *  £  £  g1(x+8,y+8)g2(x+p,y+q) 

64  (4-6) 


for 

4  _<  p  _<  12 

* 

4  <  q  <  12 


where 


g^x+S/y+8)  =  value  assigned  to  G^x+S/y+S)  element 
after  quantization 

g2(x+p,Y=q)  =  value  assigned  to  G2(x+p,y+q)  element 
after  quantization 


As  shown  in  Figure  25b,  the  six-level  quantization 
process  requires  the  additional  calculation  of  the  variances 
of  the  input  signal,  a,  for  G^x+a/y+8)  and  G2(x+p,y+q). 
Optimum  values  in  the  sense  that  they  minimize  the  variance 


of  R,  (i.e.  minimize  the  loss  in  the  signal  to  noise 
ratio  due  to  quantization (14: 28)  ),  based  on  research 
detailed  in  ref  14  are  a  =  ±3  and  b  =  ±6  for  v^/Q  =  ± 
and  Vj/c  =  ±1.4.  Thus,  the  quantized  value,  g,  is 
assigned  by: 

V  -1.4;  g  =  -6 

a 

-1.4  <  v  <  -0.6;  g  =  -3 
a 

-0.6  <  v  £  0;  g  =  -1 
a 

0<  v  <  0.6;  g  =  1 
a 

0  <  v  <  1.4;  g  =  3 
a 

1.4  £  v;  g  =  6 

a 

where 

v  *  (Intensity  value  for  a  particular  pixel-mean 
intensity  value  for  the  data  array.)  # 

For  the  six- level  quantizer  Equation  (4-5)  becomes: 

8  8 

Ruterq)  -  E  E  (g* (x+8,y+8)g,(x+p,y+q) } 


The  values  of  p  and  q  which  maximize  is  the  correlation 
point. 

b.  Fast  Fourier  Transform  (FFT)  Method.  Since  the 
arrays  to  be  correlated  are  two-dimensional,  rotating  one 
array  180*  and  taking  a  convolution  is  equivalent  to 
performing  a  correlation.  The  convolution  has  the  useful 
property  that  its  discrete  Fourier  Transform  is  a  simple 
product  of  the  Fourier  Transform  of  the  two  image  arrays 
(15:5).  This  method  substantially  reduces  the  number  of 
steps  required  to  calculate  the  correlation.  The  FFT  can 
be  used  to  calculate  the  cross-correlation  as  shown  below. 


FFT{G^  (x,y)  } 

'  Sl(fx'V 

(4-8) 

FFT{G2(x,y) } 

-  S2{fx'fy} 

(4-9) 

FFT{G^  (x,y)  *G2(x,y)  } 

-  }‘G*{fx,fy) 

(4-10) 

where 

^ (x,y) *G2 (x,y)  =  cross-correlation  of  two-dirtensional 

spatial  sequences  G ^ ( x , y )  and  G2(x,y) 

G_{f  ,f  }  =  complex  conjugate  of  Fourier  transform 

—z  ^  y 

of  sequence  G2(x,y) 

FFT  =  Fast  Fourier  Transform 

By  taking  the  inverse  FFT,  FFT  of  Equation  (4-10) , 
the  cross-correlation  of  the  two-dimensional  sequences 
G^(x,y)  and  G2(x,y)  is  obtained  (8:53,54) 


where 


R(x,y)  is  the  result  of  the  correlation 

c.  Phase  Correlation  Method.  While  the  FFT  method 
is  the  simpliest  and  most  readily  implemented  correlation 
technique,  it  possesses  the  undesirable  characteristic 
of  detecting  false  peaks,  especially  if  the  FLIR  image 
is  of  high  brightness  while  the  template  is  of  lesser 
brightness.  The  problem  stems  from  the  relative 
magnitude  of  the  intensity  of  the  sub-elements  (14:22). 

The  phase  correlation  method,  which  reduces  the 
false  peak  effects  of  the  cross-correlation,  is  given 
by  (14:22): 

(4-12) 


where 

fo.(fx'fy)  *— 2(fx,fy)!  =  magnitude  of  G^f*,^)  *G*(fx,fy) 

R^(x,y)  =  result  of  normalized  correlation  process 

This  is  essentially  a  point  by  point  normalization  in 
the  frequency  domain.  Due  to  the  normalization,  the 
magnitude  effects  which  lead  to  the  false  peaks  using 
the  FFT  method  are  reduced  and  more  dependence  is  placed 
on  the  pattern  of  the  data  points  within  the  two  arrays. 
However,  some  of  the  computational  advantage  realized 
by  using  the  FFT  method  will  be  lost.  The  computational 
loading  incurred  by  using  this  method  will  be  examined 
during  the  performance  analysis. 

d.  Sequential  Similiarity  Detection  Algorithm  (SSDA) 


R^(x,y)  =  FFT 


-1 


V  '§2(fx'V 


|2i<fx'VVfx'Vl 


y'l  J 


Another  method  considered  was  the  Sequential  Similiarity 
Detection  Algorithm.  In  this  method,  the  absolute  value 
of  the  difference  between  corresponding  pixels  of 
and  Gjr  for  each  p  and  q,  is  calculated  and  the  result 
is  defined  to  be  the  SSDA  registration  surface  shown  in 
Equation  (4-13) . 

K  L 

E{p,q}  =  £  l  |G  (x,y)-G  (x+p,y+q)  (4-13) 

x=l  y=l  1  1  2 

for 

0  <  p  <  X  <  K 
0  <  q  <  Y  <  L 

where 

| ^ (x,y) -G2 (x+p,y+q) |  =  absolute  value  of  the 

difference 

The  registration  point,  which  corresponds  to  the  correlation 
point  in  the  previous  methods,  is  defined  as  the  point  for 
which  E(p,q)  is  a  minimum.  Note  this  is  not  a  true 
correlation  technique  since  Equation  (4-13)  is  not  directly 
related  to  Equation  (4-1) .  This  method  was  not  implemented 
as  analysis  has  shown  that  two-level  quantization  of  the 
SSDA  method  is  equivalent  to  two-level  quantization  using 
the  direct  method,  and  for  all  higher  quantization  levels, 
the  direct  method  out  performs  the  SSDA  (14:46)  . 

However,  for  actual  implementation  of  a  two- level  quantizer, 
hardware  considerations  may  cause  the  designer  to  select 
this  method. 

4.4  Maximum  Correlation  Detection 


The  magnitude  of  the  components  of  the  sequence 
R(x,y)  is  a  measure  of  the  degree  of  resemblance  between 
the  template  and  the  FLIR  image  data  where  the  peak 
location  is  used  to  indicate  the  amount  of  offset 
between  the  two  arrays  that  result  in  the  highest  degree 
of  resemblance.  Thresholding  is  a  technique  often  used 
to  suppress  lower  peaks  in  the  correlation.  (Note: 

In  the  direct  method,  the  quantization  process  accomplishes 
essentially  the  same  function  thus  thresholding  was  only 
employed  for  the  frequency  domain  correlation  methods.) 
During  the  thresholding  procedure,  each  element  of  the 
R(x,y)  sequence  is  examined  to  determine  if  the  value 
for  that  element  is  below  some  preselected  fraction  of 
the  maximum  valued  element  in  the  sequence.  If  the 
element  value  is  below  that  minimum  point,  then  that 
element  is  considered  to  have  poor  correlation  and  is 
set  to  zero.  The  result  is  that  such  elements  will 
have  no  effect  on  the  computed  offset  between  the  template 
and  FLIR  data.  Figures  26  and  27  show  the  effects  of 
thresholding  as  a  result  of  setting  the  threshold  value 
to  .3  and  .5  of  the  maximum  valued  element  respectively. 
These  cases  were  conducted  under  indentical  conditions 
using  the  FFT  method  where  the  data  array  was  offset 
from  the  template  by  +.15  pixels  in  the  x  and  y  FLIR 
directions.  After  the  thresholding  process  has  edited 
the  results  of  the  correlation,  a  center  of  mass 
calculation  was  used  to  determine  the  peak  of  correlation 
between  the  two  arrays,  see  Equation  (4-14) .  These  plots 
show  the  errors  in  the  calculated  offset  between  the 
two  arrays  for  1000  cases  where  a  zero  error  in  the  plot 
indicates  the  correct  offset  was  achieved.  As  shown  in 
Figure  27,  a  higher  threshold  locates  the  true  offset 
more  often  but  false  peaks  become  prominent.  Physically 
this  can  be  explained  by  examining  the  correlation 
function  of  this  method.  For  demonstration  purposes. 
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Figure  26.  FFT  Correlation 
(Threshold  =  .3) 
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Figure  27.  FFT  Correlation 
(Threshold  =  .5) 
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assume  Figure  28  is  the  result  of  a  correlation  using 
the  FFT  method. 


R(x,y) 


Figure  28.  Thresholding  (FFT  Correlation  Method) 

* 

As  shown,  a  high  degree  of  correlation  lies  to  the  right 
of  the  main  peak.  However,  as  the  theshold  is  raised, 
this  information  is  deweighted  because  the  thresholding 
procedure  sets  these  values  to  zero  and  the  smaller 
peak  to  the  left  of  the  main  peak  becomes  weighted  more 
heavily.  When  the  center  of  mass  calculation  is  used 
to  determine  the  peak  of  the  correlation  function  the 
result  will  be  an  estimate  which  is  incorrectly  biased 
to  +-he  left.  Thus,  when  using  the  FFT  method  the  threshold 
must  be  set  low  enough  to  avoid  this  effect.  However, 
due  to  the  normalization  process  the  correlation  function 
generated  by  the  phase  correlation  method  would  be  as 


shown  in  Figure  29. 


R^(x,y) 


Figure  29.  Thresholding  (Phase  Correlation  Method) 


Therefore,  using  this  method,  a  better  estimate  of,  the 
true  peak  of  the  correlation  function  can  be  obtained  by 
raising  the  threshold  level  and  then  calculating  the 
center  of  mass. 

Once  the  thresholding  method  has  edited  the  results 
of  the  correlation,  the  point  of  maximum  correlation  must 
be  located.  Derivative-based  peak  detectors,  i.e.  a 
method  which  locates  the  point  of  zero  slope  can  be  used 
for  this  purpose.  However,  because  the  location  of  the 
point  of  maximum  intensity  could  be  rapidly  changing 
on  the  FLIR  image  plane,  as  when  the  aircraft  being 
tracked  executes  a  snap  roll,  it  was  felt  that  these 
type  detectors  might  often  misinterpret  a  local  peak  as 
the  global  peak.  Therefore,  a  centroid  summation 
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technique  was  selected  to  locate  the  center  of  mass  of 
the  edited  two-dimensional  cross -correlation  sequence, 
R^(x,y)  or  R^p^).  This  method  assumes  that  the  center 
of  mass  of  the  thresholded  or  quantized  correlation 
function  is  a  good  indication  of  the  global  peak  location. 
The  centroid  summation  used  is  defined  in  either  the 
vertical  or  horizontal  direction  as  (8:63): 


N 

C  =  Z  i'Amp.  (4-14) 

i=i _ 1 

N 

Z  Amp . 
i=l  1 


where 

i  =  vertical  or  horizontal  pixel  coordinate 
Amp  -  amplitude  value  for  that  element 
N  =  total  number  of  pixels  in  the  array 

For  example,  to  locate  the  center  of  mass  of  the 
correlation  function  in  the  horizontal  direction,  the 
horizontal  coordinates  of  all  of  the  elements  of  the 
RT(x,y)  sequence  would  be  multiplied  by  their  respective 
amplitudes  and  their  products  summed.  The  centroid's 
horizontal  coordinate  is  then  achieved  by  dividing  that 
summation  by  the  sum  of  all  the  amplitudes  in  the 
R^(x,y)  sequence.  The  same  procedure  is  then  applied 
in  the  vertical  direction.  The  result  is  that  the 
coordinates  of  the  center  of  the  correlation  function 
in  both  directions  from  the  center  of  the  template  is 
produced . 

4.5  Analysis  of  Correlation  Methods 
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This  section  analyzes  the  errors  in  the  position 
estimates  generated  by  the  four  correlation  methods 
previously  discussed.  The  statistical  data  for  the 
one  and  three  hot  spot  cases  is  presented  first, 
followed  by  a  discussion  of  each  methods's  performance. 

The  position  estimate  generated  by  the  correlation 
algorithm  will  be  the  measurements  provided  to  the 
linear  Kalman  filter  which  will  provide  a  better 
estimate  of  the  target's  position.  The  two-dimensional 
discrete  measurement  vector,  z.(t^)  ,  is  incorporated 
by  the  Kalman  filter  using  the  Equation  (3-14) . 

Software  was  developed  to  test  each  of  the  correlation 

algorithm's  position  estimate,  and  statistical  data  and 

histograms  of  the  resulting  errors  were  gathered.  For 

the  cases  to  be  discussed  the  centroid  of  the  intensity 

was  offset  from  the  template  by  .15  pixels  where  this 

distance  was  selected  as  being  representative  of  the 

propagation  error.  Simulated  background  and  FLIR  noise 

was  added  as  described  in  section  2.4,  and  1000  runs 

were  made  to  gather  the  error  statistics.  As  previously 

described,  the  errors  were  calculated  so  that  if  the 

* 

correct  offset  was  estimated  a  zero  error  is  shown  on  the 
histogram,  and  any  deviation  from  zero  is  the  error  in 
the  estimate  in  pixels.  The  estimated  offset  errors  were 
placed  into  bins  .01  pixels  wide,  and  the  plots  show  the 
number  of  times  the  estimated  position  fell  into  a 
particular  bin.  (The  bins  were  calculated  from  the  mean 
error  to  a  distance  of  the  mean  error  +  .2  pixels  where 
it  was  assumed  the  majority  of  the  errors  would  fall.) 

Thus,  while  the  area  under  all  the  curves  has  to  be 
1000  pixels,  the  total  area  will  not  appear  on  the  histogram 
if  the  calculated  offset  was  more  than  .2  pixels  from  the 
mean  offset  error.  Table  1  shows  the  correlator  errors 
for  single  hot  spot  targets  where  the  centroid  of  the 
intensity  function  was  truly  offset  from  the  template  by 


.15  as  previously  discussed,  and  the  histograms  for  these 
cases  are  presented  in  Figures  30^-33.  (Note  the  scale 
in  Figure  33  is  times  10.) 


Table  I.  Correlation  Errors  (Single  Hot  Spot  Target) 


Correlation 

Method 

V 

err 

0 

x  err 

y 

■*  err 

a 

y  err 

Time  (sec) 

Direct 

2- level 

-.00283 

.14995 

-.01012 

.14875 

255.939 

Direct 

6-level 

-.06730 

.13697 

-.07024 

.13510 

365.109 

FFT 

Thresh®. 3 

-.00113 

.13262 

-.00117 

.13374 

271.862 

Phase 

Thresh® . 7 

-.00091 

.27046 

.00166 

.27581 

281.344 

# 


where 

x _ .y _  -  mean  error  in  the  estimated  offset  in  the 

err  err 

x  and  y  FLIR  directions  respectively 

a  ,a  -  standard  deviation  of  the  errors  in  the 

x  ell  y  i 

x  and  y  FLIR  directions  respectively 

Time  -  total  computer  simulation  time  for  1000 
runs  where  all  parameters  were  identical 
except  the  correlation  method  employed 


The  threshold  values  used  for  the  FFT  and  phase  correlation 
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Figure  30.  Histogram  of  Errors-Direct  Method 
(2-level  quantization,  1  hot  spot) 


NUMBER  OF  OCCURRENCES  NUMBER  OF  OCCURRENCES 

).00  45.00  90.00  135. OG  ,0.00  45.00  90.00 


methods  were  chosen  as  the  best  values  to  implement  based 
on  a  comparison  with  other  trials  where  various  thresholds 
were  used.  The  threshold  value  which  produced  the  smallest 
rms  error  was  chosen. 

An  error  analysis  was  also  conducted  for  the  three 
hot  spot  target  case.  As  in  the  previous  simulations, 

1000  runs  were  used  to  gather  the  statistical  information. 
The  results  of  the  three  hot  spot  cases  are  shown  in 
Table  II. 


Table  II.  Correlation  Errors  (Three  Hot  Spot  Target) 


Correlation 

Method 

xerr 

a 

x  err 

y 

■*err 

a 

y  err 

Time  (sec) 

Direct 

2- level 

-.03304 

.04116 

-.01798 

.10846 

306.268 

Direct 

6- level 

-.08426 

.04770 

.01754 

.03696 

400.785 

FFT 

Thresh= . 3 

-.00053 

.03858 

.00225 

.05428 

319.056 

Phase 

Thresh=. 7 

.00058 

.09854 

-.00422 

.27691 

325.461 

The  histograms  of  the  three  hot  spot  cases  are  shown  in 
Figures  34-37.  (Again,  in  Figure  37  the  scale  is  times  10.) 
For  the  three  hot  spot  cases,  the  difference  in  errors  in  the 
x  and  y  direction  is  due  to  the  location  of  the  three 
target  intensity  profiles.  The  centroids  of  the  intensity 
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Figure  35.  Histogram  of  Errors-Direct  Method 
-level  quantization,  3  hot  spots) 
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Figure  36.  Histogram-FFT  Method 


(threshold  =  .3,  3  hot  spots) 


profiles  were  located  so  that  if  the  center  of  the  8x8 
pixel  FLIR  tracking  window  was  located  at  coordinates 
(0,0)  then  the  target  centroids  would  be  at  (0,-2,667), 
(-2,1.33),  and  (2,1.33).  This  spacing  means  the  center 
of  mass  of  the  intensity  profiles  is  at  (0,0)  but  the 
resultant  intensity  profile  is  not  radially  symmetric 
about  (0,0).  In  order  to  insure  these  statistics  were 
representative  of  the  true  correlator  errors  and  hot 
of  just  one  particular  offset  distance  chosen,  which  may 
have  enhanced  or  degraded  the  performance  of  a  particular 
correlation  method,  evaluations  were  conducted  for  other 
offset  distances  between  the  target  and  the  template. 

The  error  statistics  for  these  cases,  not  shown,  verified 
that  the  cases  presented  in  Tables  1  and  2  were  representative 
of  the  performance  of  the  correlation  methods. 

Tables  1  and  2  and  Figures  (30-37)  were  analyzed  to 
determine  which  correlation  methods  were  best  suited  for 
implementation  with  the  Kalman  filter: 
a.  Direct  Method:  (two-level  quantization) :  This  is 
clearly  the  fastest  of  the  four  correlation  methods 
considered.  For  the  one  hot  spot  case  its  performance 
is  comparable  to  the  other  methods  with  errors  which 
could  be  modeled  as  Gaussian.  However,  the  mean  error 
of  this  method  increases  from  the  one  to  three  hot  spot 
case,  which  is  not  surprising  since  this  method  only 
catagorizes  the  intensity  values  as  above  or  below  the 
mean  intensity  levels.  Thus,  when  there  are  three 
hot  spots  of  the  same  maximum  intensity  on  the  FLIR  plane, 
this  method  has  difficulty  determining  the  global  peak. 

This  accounts  for  the  erratic  nature  of  the  errors  in 
Figure  34.  In  the  x-direction,  where  the  intensity 
pattern  is  symmetric,  the  method  performs  well.  However, 
in  the  asymmetric  y-direction,  there  are  peaks  around  0.0 
and  ±.15  pixels  indicating  the  method  is  finding  the 
global  peak  at  times  and  is  misinterpreting  the  peak  of 


one  of  three  hot  spots  as  the  global  peak  at  other  times. 

To  model  these  errors  as  Gaussian  would  be  questionable. 
Based  on  the  performance  degradation  in  the  three  hot  spot 
case,  this  method  was  not  implemented.  However,  if 
computational  loading  is  the  driving  factor,  this  method 
could  become  more  attractive. 

b.  Direct  Method  (six- level  quantization) :  The  performance 
of  this  method  is  comparable  to  FFT  and  phase  correlation 
method  with  errors  which  are  well  modeled  as  Gaussian. 

The  correlator  performs  extremely  well  in  determining 
the  peak  in  the  asymmetric  y-direction  in  the  three  hot 
spot  case.  However,  the  computational  loading  associated 
with  this  method,  while  gaining  no  real  performance 
enhancement  over  the  FFT  and  phase  correlation  methods, 
is  too  great  for  this  method  to  be  considered  for 
implementation . 

c.  FFT  Method  (Threshold  =  .3) :  The  threshold  was  set 
low  while  using  this  method  to  avoid  the  appearance  of 
false  peaks  which  lead  to  a  biased  estimate  (Figure  27) . 

This  correlator  performs  well  with  errors,  in  both 
the  single  and  multiple  hot  spot  cases,  which  are  well 
modeled  as  Gaussian,  and  in  almost  all  instances,  fias 
the  smallest  standard  deviation.  The  results  of  this 
analysis  are  consistent  with  the  analyses  performed 

by  Rogers  (8:  Chapter  V)  and  this  method  was  implemented 
with  the  Kalman  filter. 

d.  Phase  Correlation  Method  (Threshold  =»  .7):  As 
expected,  this  method  substantially  reduced  the  biasing 
which  can  occur  in  the  FFT  method  with  the  histograms 
appearing  as  a  spike.  However,  the  computational 
increase  is  not  substantial.  Noting  the  large  standard 
deviation  of  this  method,  the  errors  committed  cannot  be 
well  represented  as  Gaussian  which  may  potentially  cause 
problems.  However,  because  this  method  does  consistently 


locate  the  true  global  peak  of  the  intensity  function, 
it  was  implemented  with  the  Kalman  filter  and  a  comparison 
of  the  tracking  performance  of  this  correlation  method 
and  the  FFT  method  is  presented  in  Chapter  5. 


V.  Performance  Analysis 


5.1  Introduction 

This  chapter  presents  the  tracking  performance  of 
the  correlator/Kalman  filter  when  evaluated  against  the 
trajectories  described  in  Chapter  2.  The  first  section 
of  the  chapter  gives  an  explanation  of  how  the  statistics 
used  to  evaluate  the  tracker's  performance  are  computed. 

The  next  section  of  the  chapter  discusses  those  parameters 
within  the  computer  simulation  which  were  changed  to 
evaluate  the  tracker's  performance  under  various  conditions. 
The  third  section  of  the  chapter  discusses  those  parameters 
within  the  correlator/Kalman  filter  which  can  be  adjusted 
off-line  in  order  to  enhance  the  tracking  ability  of  the 
filter.  The  final  section  of  the  chapter  condenses  the 
results  of  the  tracking  performance  into  tables.  The 
statistical  information  of  this  chapter  was  generated 
using  Monte  Carlo  techniques  (12:329) .  Based  on  previous 
variance  convergence  analyses  (6,7),  10  Monte  Carlo  runs 
were  determined  to  be  sufficient  to  generate  sample 
statistics  that  are  representative  of  the  true  procJess 
statistics,  and  therefore,  10  runs  constitute  one  Monte 
Carlo  study.  Each  single  run  consisted  of  a  5  second, 
or  150  sample  period,  simulation. 

5.2  Tracking  Ability 

The  errors  of  primary  interest,  with  respect  to  the 
tracking  ability  of  the  filter,  are  errors  in  the 
estimated  values  of  ^d(tj)  ,  and  ^d^i^  * 

Additionally,  since  the  propagated  estimate  of  the  intensity 
centroid's  location,  xpeaJc(ti^1)  and  •  wil1 

affect  the  correlation  process,  it  is  important  to 
estimate  this  position  accurately.  The  mean  error  in  the 


correlator/Kalman  filter's  estimate  for  the  x-dynamic 
position  can  be  calculated  at  any  time  t^  by 

_  N  N 

Ex  <t . )  -  1  E  (xdf  (t,)-xd  <t.)>  .11  e  d  (t.) 

d  1  N  k-1  aIk  k  1  N  k=l  k  1 


where 


Ex  <V 

xd  1 


mean  error  (i.e.  ensemble  average  error 
over  all  simulations)  in  the  x-dynamic 
position  at  time  t^ 


xaflc(ti) 


=  filter  estimated  x-dynamics  value  at  time 


t^  for  simulation  k 


x^t  (t^)  *  truth  model,  x-dynamics  value  at  time  t^ 
^  for  simulation  k 


N  *  number  of  Monte  Carlo  runs 


and  the  variance  of  the  error  is  calculated  as 


’  -5^  z  exa  (ti>-  JL  Ex  (ti'  ( 

Equations  (5-1)  and  (5-2)  can  be  generalized  to  calculate 
the  errors  in  the  other  quantities  of  interest  previously 
discussed.  Additionally,  time  averages  of  the  mean  error 
and  variance  were  calculated  over  the  last  1.5  seconds 
of  the  simulation.  This  time  averaging  interval  was 
selected  so  that  any  transient  effects  caused  by  changes 
in  the  target  dynamics  would  have  decayed.  This  provides 
45  sample  runs,  to  serve  as  an  indicator  of  the  tracker's 
performance:  time  averaging  these  allows  for  a  compact 
presentation  in  tabular  form. 


5 . 3  Variation  of  Truth  Model  Parameters 


Parameters  within  the  truth  model  are  changed  to 
analyze  the  sensitivity  of  the  correlator/Kalman  filter 
to  changes  in  the  "real  world".  The  primary  goal  of  the 
research  was  to  evaluate  the  performance  of  the  tracker 
against  targets  displaying  the  various  dynamic  profiles 
described  in  Chapter  2.  Thus,  the  4  trajectories 
previously  described  were  the  primary  truth  model  factors 
varied  to  evaluate  the  tracker  performance.  In  addition, 
variations  were  also  considered  in  parameters  defining 
the  target  intensity  profile  itself.  To  evaluate  the 
performance  of  the  tracker  when  the  strength  of  the 
maximum  target  intensity  value  changes  relative  to  the 
background  noise,  the  signal-to-noise  ratio  (SNR) 
defined  as 


S  =  *max  (5-3) 

N  CB 


where 


I  =  maximum  target  intensity  value  # 

max 

a_  =  rms  value  of  background  noise,  including  FLIR 

O 

noise  contributions 

is  varied.  For  the  multiple  hot  spot  cases,  the  values 
of  the  three  Gaussian  intensities  were  equal.  Signal 
to  noise  ratios  of  20  (standard)  and  10  were  considered 
as  representative  of  realistic  tracking  scenarios. 

The  spread  parameter,  apV'  the  target's  Gaussian 
intensity  profile (s)  can  be  varied  to  evaluate  the  performance 
of  the  tracker  against  sharply  peaked  (small  Opy)  °r 
broad  (large  <JpV)  Gaussian  target  intensities.  However, 
because  the  effects  of  varying  this  parameter  were 
previously  investigated  by  Rogers  (8:Chapter  6) ,  a 


standard  value  of  2.0  was  used  throughout  this  research 
(of  course,  opv  changed  as  a  function  of  range  to  the 
target  within  a  given  simulation) .  However,  the  target 
aspect  ratio  (AR) 


AR  ■  ^V 
a 

pv 

was  varied  to  evaluate  the  tracker's  performance  against 
targets  exhibiting  different  intensity  profiles  due  to 
varying  the  aspect  angle. 

5.4  Variation  of  Data  Processing  Parameters 

Several  parameters  are  available  within  the  data 
processing  algorithm,  upper  path  of  Figure  1,  which  can  be 
varied  to  improve  the  estimate  of  the  intensity  function. 

The  8x8  FLIR  tracking  window  can  be  padded  with  zeros 
if  the  intensity  spread  parameters,  ov  and  opv,  are  such 
that  the  target  intensity  height  is  approaching  zero 
near  the  edge  of  the  8x8  tracking  window.  However,  if 
these  parameters  are  such  that  significant  intensify 
magnitudes  exist  outside  the  8x8  tracking  windows,  then 
padding  with  zeros  would  induce  an  artifical  edge  (see 
Chapter  4) .  Therefore,  the  algorithm  was  structured  so 
the  8x8  FLIR  window  could  be  padded  with  noise-corrupted 
data  when  necessary.  Based  on  the  results  of  Roger's 
research  (8:Chapter  6),  and  because  in  a  dynamic  tracking 
environment  significant  intensity  values  may  exist  near 
the  edge  of  the  tracking  widnow,  the  FLIR  tracking  window 
was  padded  with  noise-corrupted  data  in  this  study. 

Alpha,  the  relative  weighting  parameter  for  the 
exponential  smoothing  process  is  the  next  parameter  which 
may  be  varied  within  the  data  processing  algorithm.  Equation 
(1-4)  displays  the  role  of  this  parameter  in  the  algorithm. 


The  standard  value  used  in  this  research  was  .05.  This 
value,  which  indicates  that  the  target  intensity  profile 
is  essentially  averaged  over  the  most  recent  20  sample 
periods,  was  considered  appropriate  for  targets  whose 
intensity  projection  was  relatively  constant.  However,  if 
the  intensity  pattern  on  the  FLIR  image  plane  is  varying 
so  that  significant  changes  could  occur  within  a  20-sample 
period  interval  of  time,  such  as  for  a  target  performing 
a  roll  maneuver,  increased  emphasis  should  be  placed  on 
the  more  recent  measurements.  The  effects  of  increasing 
alpha  in  this  situation  are  explored. 

5.5  Variation  of  Filter  Parameters 

Design  parameters  within  the  Kalman  filter  structure 
are  varied  either  off-line  during  a  filter  tuning 
process  or  adaptively  in  real-time  in  an  attempt  to  improve 
the  quality  of  the  state  estimates.  The  parameters  in  the 
linear  Kalman  filter,  developed  in  Chapter  3,  which  may 
be  varied  during  the  off-line  filter  tuning  process,  and 
the  values  of  which  may  change  for  different  target 
trajectories  are  the  target  acceleration  and  atmospheric 
jitter  time  constants,  and  xa£,  the  discrete-time 

noise  covariance  matrix,  Q the  strength  of  which  may 
be  interpreted  as  a  measure  of  the  uncertainity  in  the 
dynamics  model  being  used,  (i.e.  how  adequately  the 
assumed  model  represents  the  "real  world”) ,  the  measurement 
uncertainity  covariance  matrix,  R,  and  the  initial  filter 
covariance  matrix,  P(tg) . 

Based  upon  previous  research  efforts  (6,8,10)  the 
assumed  correlation  time  for  the  atmospheric  jitter 
position  was  set  at  ..0707  sec.  Using  this  value  assumes 
the  effects  of  repeated  poles  shown  in  Equation  (2-2)  are 
considered  negligible.  The  variance  of  the  atmospheric 
jitter  process  was  set  at  a  constant  .2  (pixels  ) .  The 
diagonal  terms  for  the  R(t^)  matrix  were  based  on  the 


statistical  analysis  of  the  correlation  process  detailed 
in  Chapter  4.  The  cross-correlation  between  the  errors 
in  each  of  the  FLIR  image  plane  directions  in  the  correlation 
process  was  calculated  and  proved  to  be  small  enough  to 
assume  that  the  correlation  position  uncertainty  estimate 
in  one  direction  is  independent  of  the  uncertainty  of  the 
position  estimate  in  the'  other  direction,  resulting  in 
a  diagonal  R(t^) .  Thus,  the  parameters  which  were  used 
to  tune  the  filter  to  optimize  filter  tracking  performance 
were  x^  and  c^. 

For  the  type  of  targets  being  tracked  in  this  research, 
target  acceleration  time  constants  ranging  from  1  to  4  secs 
were  used  where  a  lower  xd£  is  more  appropriate  for  a 
highly  dynamic  tracking  environment.  Values  of  ranged 
from  150  (pixels  /sec3)  to  500  (pixels  /sec3)  depending  on 
the  type  of  trajectory  being  tracked,  where  was 
increased  for  highly  dynamic  targets.  The  wide  disparity 
in  the  values  used  for  and  directly  reflects  the 
range  of  rms  accelerations  between  benign  versus  harshly 
maneuvering  targets  and  their  relationship  with  the  jitter 
rms  value. 

In  the  filter  tuning  process,  the  P(tQ)  matriSc  is 
set  to  reflect  the  knowledge  of  the  conditions  under 
which  the  estimation  process  is  to  be  initiated.  Since 
in  realistic  scenarios,  the  filter  may  very  well  receive 
inaccurate  handoff  information  from  the  target  acquisition 
source  (such  as  a  multi-target  search  radar) ,  the  diagonal 
entries  of  P(tg)  were  purposefully  set  high  to  reflect  this 
handoff  uncertainty.  The  appropriate  values  at  which  to 
initialize  variances  on  the  main  diagonal  were  determined 
by  observing  the  peak  values  of  each  of  these  terms  during 
the  filter  transient  period.  The  variances  on  the  main 
diagonal,  for  position,  velocity,  and  acceleration,  were 
10  (pixels2),  2000  (pixels2/sec2) ,  and  100  (pixels2/sec*) 
respectively.  The  initial  values  of  the  P(tg)  matrix  will 
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be  the  dominant  factor  in  the  initial  transient  characteristics 
of  the  filter  (12:337).  When  tuning  the  filter,  a  useful 
technique  is  to  compare  the  value  of  the  actual  rms  errors 
committed  by  the  filter  to  the  filter's  own  representation 
of  the  error  covariance.  The  time  histories  of  these 
errors  are  available  as  the  output  of  the  Monte  Carlo 
simulation  process  used.  By  "matching"  the  filter's  rms 
estimation  of  its  errors  to  the  true  rms  errors  committed 
by  the  filter,  an  attempt  is  made  to  insure  that  the  proper 
relative  weighting  is  given  to  the  internal  dynamics  model 
and  the  measurements  (12:338-339). 

5.6  Plotting  Results 

An  explanation  of  the  plots  generated  to  depict  the 
filter's  tracking  errors  are  given  in  this  section,  with 
the  plots  which  served  as  the  baseline  case  for  the 
correlator/Kalman  filter  being  shown.  The  remainder  of 
the  performance  plots  are  given  in  Appendix  C.  For  each 
run,  ten  plots  were  generated.  The  first  two  plots 
show  the  filter-computed  rms  errors  versus  the  actual  rms 
errors  in  the  x  and  y  dynamics  positions.  The  nex£  four 
plots  show  the-  mean  errors  in  the  x  and  y  dynamics  position 
estimates  +  one  standard  deviation,  beginning  with  the 
first  plot  showing  the  filter's  estimate  at  time  minus  and 
the  second  plot  showing  the  filter's  estimate  at  time  plus. 
Similarly,  the  next  four  plots  give  the  errors  in  the 
filter's  estimates  of  the  centroid  position  at  times  minus 
and  plus.  The  case  number  on  each  plot  is  used  to  match 
each  run  with  the  tables  shown  in  the  next  section.  By 
referring  to  these  tables,  the  trajectory,  truth  model 
parameters,  and  filter  parameters  can  be  cross-referenced. 
Additionally,  a  summary  of  the  parameter  values  for  each 
case  is  given  at  the  end  of  the  chapter. 

Referring  to  Figure  38a,  it  is  seen  that  the  filter 
was  intentionally  set  to  overestimate  its  own  errors. 
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Figure  38f.  Case  1 
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i.e.,  it  was  "conservatively”  tuned.  The  reason  for  this 
conservative  tuning  which  is  used  to  guard  against 
possible  filter  divergence  is  explained  by  referring  to 
Figure  35c.  As  shown,  the  filter  mean  error  has  a 
transient  characteristic  which  lasts  for  approximately 
two  seconds.  In  an  attempt  to  minimize  this  transient, 
the  conservative  tuning  was  used.  The  reason  for  this 
unexpected  transient  characteristic  is  not  completely 
understood.  However,  a  discussion  of  possible  causes  is 


included  in  the  next  chapter.  Also  note  the  filter  was 


given  perfect  knowledge  of  the  initial  conditions  through 
xf (tQ+) . 


Analysis  of  Filter  Performance 


The  results  of  the  filter's  performance  will  be 
presented  in  tabular  form  in  this  chapter  and  in  graphical 
form  in  Appendix  C.  The  error  statistics  shown  in  the 
tables  are  the  temporal  averages  of  the  mean  errors  and 
standard  deviations  from  t  *  3.5  to  t  =  5.0.  For  the 
truth  model  parameters,  the  following  standard  values 
were  used  unless  specifically  noted  in  the  comments^ 
section  of  the  table: 

a)  Aspect  Ratio  (AR)  =  1 

b)  Intensity  Function  Spread  Parameter  (o^y)  =  2 

c)  Signal  to  Noise  Ratio  (SNR)  =  20 

d)  Maximum  Hot  Spot  Intensity  (I  )  *  20 

IudX 

Thus,  combining  c  and  d  above  yields  a  rms  background 
noise  value  =  1. 

The  first  line  in  the  header  entry  for  each  of  the 
tables  gives  those  parameters  which  were  used  for  filter 
tuning  where  and  are  as  previously  defined  and 
a  is  the  exponential  smoothing  parameter  shown  in  Equation 
(1-4) .  The  truth  model  parameters  which  were  often  varied 
from  one  Monte  Carlo  run  to  another  are  given  in  the  second 
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line  of  the  header  column.  The  first  entry  references 
the  trajectories  defined  in  section  2.3.  For  trajectory 
2  which  is  the  pullup  maneuver,  the  dynamics  of  the  turn 
(g- factor)  are  shown  in  the  comments  column.  The  second 
entry  gives  the  roll  rate,  u>,  for  the  run  in  rad/sec. 

The  final  truth  model  entry  in  the  header  column  gives 
the  number  of  hot  spots  ( NUMHS )  used  for  the  run. 

The  statistics  presented  in  the  tables  are  defined  as: 

xe  =  average  of  the  mean  error  for  the  true 
position  in  the  x-direction  from  t  *  3.5 
to  t  =  5.0  at  times  minus  and  plus 
(similarly  for  yfi) 

oxfi  =  average  of  the  standard  deviation  of  the 
true  position  in  the  x-direction  from 
t  =  3.5  to  t  s  5.0  at  times  minus  and 
plus  (similarly  for  oye) 

cxe  and  acx0  =  errors  as  defined  above  for  the  centroid 

position  (similarly  for  cye  and  acyfi) 

t 

5.8  Evaluation  of  Correlation  Methods 

Based  on  the  analysis  of  the  correlation  methods 
detailed  in  Chapter  4,  the  FFT  and  phase  correlation 
methods  were  incorporated  into  the  tracking  algorithm, 
to  evaluate  the  performance  of  each  in  a  tracking  environment. 
The  correlators  were  evaluated  under  a  benign  tracking 
environment,  trajectory  1,  against  targets  exhibiting 
both  single  and  multiple  hot  spots.  The  results  of  the 
performance  evaluation  are  shown  in  Table  III.  For  the 
single  hot  spot  case,  the  FFT  method  has  a  smaller  mean 
error  the  the  y-position,  while  the  phase  correlation 
method  produces  better  mean  estimates  in  the  x-direction. 
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Table  III.  Correlator  Performance  Results 


Case  4  3. 5, 150,. 05  .286/  .258/  .198/  .139/  .063/  .058/  .068/  .059/ 

Phase  Cor  1,0,3  .315  .302  .339  .292  .292  .281  .331  .292 


However,  the  FFT  method  produces  the  best  position 
estimates  in  both  directions  in  the  three  hot  spot  cases. 

The  data  presented  in  Table  III  can  be  used  to  calculate 
the  rms  error,  defined  as  rms  =  /m2+a2 .  A  calculation 
of  this  statistic  revealed  that  in  all  cases  the  phase 
correlation  method  had  a  rms  error  which  was  approximately 
50%  greater  than  the  FFT  rms  error.  Addi tonally,  the 
standard  deviation  of  the  FFT  method  is  substantially 
smaller  in  all  cases,  as  expected  based  on  the  analysis 
of  the  correlation  methods.  Therefore,  the  FFT  method 
was  chosen  as  the  correlation  method  to  be  used  in  the 
remainder  of  the  evaluations.  Since  the  mean  tracking 
errors  were  slightly  larger  in  the  three  hot  spot  case 
for  the  FFT  method,  the  remainder  of  the  evaluations 
were  made  for  three  hot  spot  targets,  with  case  1  to 
serve  as  the  baseline  for  the  correlator/Kalman  filter 
performance . 

5.9  Evaluation  of  Harnly  and  Jensen  EKF 

With  case  1  of  Table  III  established  as  the  performance 
baseline  for  the  correlator/Kalman  filter  in  the  single  hot 
spot  case,  the  8-state  EKF  designed  by  Harnly  and  Jensen  (6) , 
which  uses  a  Brownian  motion  acceleration  model  and  a 
bivariate  Gaussian  measurement  model,  was  evaluated  to  provide 
a  performance  benchmark.  The  Harnly-Jensen  cases  are 
referred  to  by  letters  whereas  the  correlator/Kalman 
filter  cases  are  numbered.  The  first  case,  case  A,  was 
conducted  with  the  same  truth  model  parameters  used  in 
case  1.  As  shown  in  Figures  39a  and  39b,  the  filter  is 
well-tuned  for  this  scenario.  Although  not  accomplished, 
extended  Kalman  filters  are  often  tuned  by  comparing 
the  filter  computed  covariance  to  the  actual  rms  error 
instead  of  the  actual  standard  deviation  to  minimize 
any  bias  effects.  As  in  the  previous  cases,  the  filter 
was  initialized  with  perfect  state  knowledge  so  no  recovery 
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period  is  observed.  (Note:  The  position  plots  are  for 
the  errors  at  time  plus.)  The  statistics  for  the  run 
were  averaged  as  before  from  t  =  3.5  to  5.0  and  are  shown 
in  Table  IV.  (Note:  The  statistics  shown  are  the  only 
position  calculations  available  from  the  Harnly-Jensen 
routine.)  When  this  case  is  compared  to  case  1,  it  is 
seen  that  in  the  x-direction  the  mean  error  bias  present 
in  the  correlator/Kalman  filter  is  not  present  in  the  EKF, 
with  which  excellent  tracking  is  obtained.  However,  the 
EKF  has  a  slightly  larger  standard  deviation.  In  the 
y-direction  similar  error  characteristics  are  noted  with 
the  EKF  having  the  smaller  mean  error  and  the  correlator/ 
Kalman  filter  having  the  smaller  standard  deviation. 
Calculation  of  the  rms  errors  from  the  table  data  shows 
the  rms  error  for  the  Harnly-Jensen  EKF  is  .06  pixel  less 
in  the  x-direction  and  .01  pixel  greater  in  the  y-direction. 

Table  IV.  Harnly-Jensen  EKF  Performance 
Header  (a^f) 

(Trajectory) 

* 


Note:  Case  B  statistics  not  given  due  to  filter  divergence 
at  the  end  of  simulation. 
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The  next  run  with  the  filter,  case  B,  was  a 
2-g  pullup  maneuver  using  trajectory  2.  The  performance 
plots  for  this  case  are  shown  in  Figures  40a-d.  When 
this  case  is  compared  to  cases  12  and  13  for  the  correlator/ 
Kalman  filter,  which  are  presented  in  section  5.12,  it 
is  seen  that  the  EKF  responds  better  at  maneuver  initiation 
with  the  mean  tracking  error  being  0.5  pixel  at  the 
maximum  point  as  compared  to  a  1.0  mean  pixel  error  for 
the  correlator/Kalman  filter  (see  Figures  40d  and  C-12d 
of  Appendix  C) .  Additionally,  the  EKF  recovers  to 
essentially  a  zero  mean  error  in  0.75  sec  whereas  the 
correlator/Kalman  filter  has  a  transient  of  1.0  sec. 

Note  in  the  Harnly- Jensen  cases  the  mean  errors  are 
calculated  by  subtracting  the  filter  estimated  states 
from  the  true  states,  opposite  of  Equation  (5-1) ,  which 
accounts  for  the  plot  differences.  However,  at  the  end 
of  this  simulation  the  Harnly-Jensen  filter  estimates  in 
the  y-direction  begin  to  diverge.  At  this  point,  the 
target  is  approaching  the  position  of  closest  approach, 
where  it  will  transition  from  closing  on  the  tracker 
location  to  receding  from  the  tracker  location.  Therefore, 
the  FLIR  frame  and  its  reference  system  must  rotat^  at 
a  greater  rate  than  at  any  other  point  in  the  simulation 
to  keep  the  target  centered  in  the  FOV.  This  rotation 
creates  a  non-inertial  acceleration,  and  appeared  in  a 
6-state  filter  which  did  not  model  acceleration  employed 
by  Harnly-Jensen  in  a  manner  very  similar  to  case  B. 

However,  when  Harnly-Jensen  added  the  two  acceleration 
states  to  the  EKF,  this  divergent  characteristic  was  not 
observed.  Since  many  of  the  truth  model  parameters  are 
not  the  same  as  in  the  Harnly-Jensen  simulations  a  direct 
comparison  cannot  be  made.  It  is  also  noted  that  even  at 
the  end  of  case  A,  the  filter's  standard  deviation  in  the 
y-direction  becomes  larger  which  may  have  been  caused  by 
the  same  source. 
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In  order  to  determine  if  the  geometry  of  trajectories 
1  and  2  had  a  bearing  on  the  increase  in  y-position  errors, 
a  special  trajectory  was  designed  which  avoided  the 
crossover  situation.  For  this  special  trajectory,  the 
simulation  was  initiated  with  inertial  coordinates 

XjUq)  =  20000.  m 

yi(tQ)  =  10000.  m 

zx (tQ)  =  30000.  m 

and  the  constant  velocity  used  during  the  entire  simulation 
was 


Xjft)  *  -500.  m/sec 
yj(t)  =  -300.  m/sec 
Zj(t)  =  0.  m/sec 

This  presents  a  more  benign  flight  profile  than  before 
and  the  crossover  point  is  avoided.  Figures  41c  and  d 
show  that  in  this  situation  the  filter  tracks  the  target 
very  well  for  the  entire  simulation,  indicating  that  the 
cause  of  the  filter  difficulties  in  the  prior  cases  may 
be  attributable  to  the  trajectory  geometry.  The  error 
statistics  for  this  simulation  are  given  as  case  C  in 
Table  IV.  Also,  while  not  indentical  this  simulation 
is  very  similar  to  case  36  in  the  Harnly-Jensen  thesis, 
and  the  observed  tracking  performance  between  these  two 
cases  are  analogous.  Due  to  the  difficulties  encountered 
with  this  filter,  the  5-g  case  was  not  evaluated  because 
of  the  similarity  in  the  trajectory  geometry.  However, 
for  future  studies  this  case  could  be  evaluated  in  a 
situation  where  the  crossover  geometry  is  avoided. 

Simulations  were  conducted  with  the  EKF  to  determine 
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how  the  filter  would  respond  in  a  muliple  hot  spot 
environment.  The  hot  spots  were  intentionally  spaced 
so  that  their  projection  onto  the  FLIR  image  plane  could 
be  approximated  as  bivariate  Gaussian,  which  is  the  form 
used  in  the  measurement  model  of  the  EKF  employed  by 
Harnly- Jensen.  To  achieve  this  spacing,  the  centroid 
of  one  hot  spot  was  initially  placed  at  the  center  of 
the  overall  target  centroid  while  the  other  hot  spots 
were  symmetric  about  the  centroid  at  a  distance  of 
+  1  pixel.  The  spread  parameter,  a g,  was  2.  Initially, 
the  filter  tracked  the  target  but  as  the  simulation 
progresses  the  hot  spot  orientation  changes.  Due  to 
this  effect  which  results  in  an  intensity  pattern  no 
longer  well  approximated  as  bivariate  Gaussian  the 
Monte  Carlo  simulations  were  not  successful  as  the  filter 
repeatedly  lost  target  track  2  to  3  seconds  into  the 
simulations.  During  the  phase  of  the  simulation  prior 
to  loss  of  target  track,  the  position  estimates  in  both 
directions  oscillated  between  a  +  2  pixel  error  which 
roughly  corresponds  to  the  displacement  distances  between 
the  hot  spot  centroids  on  the  FLIR  plane.  (The  hot  spot 
separation  distance  increases  as  the  target  approaches  the 
FLIR  location.)  It  appears  the  filter  was  moving  from 
hot  spot  to  hot  spot  during  the  estimation  process. 

5.10  Evaluations  Using  Trajectory  1. 

With  the  baseline  cases  established  for  the  one  and 
three  hot  spot  cases,  trajectory  1  was  used  to  evaluate 
how  changes  in  a,  SNR,  and  AR,  would  affect  the  tracking 
performance.  The  results  of  these  runs  are  shown  in 
Table  V.  Changing  a  from  .05  as  in  case  3  to  0.1  as  in 
case  5  results  in  only  slight  changes  in  the  tracker's 
performance.  In  general,  case  5  has  slightly  smaller  mean 
errors  while  case  3  has  slightly  smaller  standard  deviations. 
The  rms  error  is  .01  pixel  less  for  case  5  in  the  x-direction, 


Table  V.  Trajectory  1  Evaluations 


While  in  the  y-direction  the  rms  error  for  the  two  cases 
is  approximately  the  same.  Since  increasing  the  a  for 
the  case  does  not  clearly  improve  or  degrade  the  performance 
of  the  tracker,  it  appears  that  for  cases  where  the  intensity 
pattern  is  not  rapidly  varying,  an  a  in  the  range  of 
.05  -  0.1  is  appropriate.  These  values  will  be  investigated 
later  when  the  intensity  pattern  does  show  motion  on 
the  FLIR  image  plane.  For  case  6,  the  true  signal  to 
noise  ratio  was  changed  from  the  standard  value  of  20  to 
10  while  the  filter  was  told  the  SNR  was  20.  The  performance 
of  the  tracker  is  relatively  unaffected  by  this  signal- 
to-noise  change,  as  was  previously  shown  by  Mercier  (10) . 
Although  the  case  was  not  tested,  Mercier  and  Harnly- 
Jensen  showed  that  while  going  from  a  SNR  of  20  to  10  has 
very  little  effect  on  the  tracker's  performance,  going 
from  a  SNR  of  10  to  1  results  in  a  definite  degradation 
in  the  filter's  performance. 

The  last  case  in  Table  V  shows  the  result  of 
changing  the  aspect  ratio  from  1  to  2.  For  this  particular 
scenario,  this  means  the  spread  of  the  intensity  pattern 
is  twice  as  great  in  the  xFLIR  direction  as  in  the  yFLIR 
direction.  As  a  result,  the  tracking  ability  is  relatively 
unaffected  in  the  yFLIR  direction,  while  in  the  xFLIR 
direction  an  appreciable  increase  in  the  mean  tracking 
error  is  noted.  Thus,  it  appears  that  when  the  spread 
of  the  intensity  function  is  increased,  the  tracker, 
and  most  probably  the  correlator,  has  difficulty  determining 
the  location  of  the  centroid  of  the  intensity  function. 

5.11  Evaluation  for  Rolling  Maneuvers. 

To  evaluate  the  performance  of  the  tracker  when  the 
intensity  patterns  were  rapidly  changing  on  the  FLIR 
image  plane  a..  I  to  evaluate  how  changing  ot  affected  the 
tracker’s  performance  under  this  circumstance,  a  roll 
maneuver  was  used.  Trajectory  1  was  used  for  the  target 


flight  path  to  provide  a  benign  trajectory  to  minimize 
possible  errors  due  to  trajectory  effects  and  to  concentrate 
on  how  the  changing  target  shape  effects  are  handled  by 
the  tracker.  Roll  rates  of  0.5  rad/sec  and  1.0  rad/sec 
were  used.  In  both  instances,  the  roll  maneuver  was 
initiated  at  t^  =  .5  sec. so  the  filter  would  have  acquired 
the  target  prior  to  roll  initiation,  and  the  roll  maneuver 
continued  at  a  constant  rate  for  the  remainder  of  the 
simulation.  This  results  in  a  total  roll  angle  of  128.9° 
and  258.0°  for  the  two  cases  respectively.  The  results 
of  these  runs  are  shown  in  Table  VI. 

A  general  observation  on  the  tracking  performance 
against  the  rolling  maneuver  is  that  the  mean  errors 
are  slightly  less  in  the  x-direction  and  slightly  greater 
in  the  y-direction  when  compared  to  the  non-rolling  cases. 

For  the  crossing  trajectory  with  no  roll,  the  intensity 
profiles  are  more  symmetric  in  the  yFLIR  direction  than 
in  the  XpLIR  direction,  and  recalling  the  correlator  performance 
analysis  (Figure  36) ,  the  correlator  performs  much  better 
in  the  symmetric  case.  This  plus  the  fact  that  there  is 
very  little  motion  in  the  y-direction  helps  to  accqjunt  for 
the  difference  in  the  mean  errors.  However,  in  the  rolling 
case,  the  intensity  profiles  will  be  more  symmetric  in  the 
x-direction  at  times,  and  in  the  y-direction  at  other  times, 
which  accounts  for  the  general  trend  in  the  mean  error 
changes . 

For  the  0.5  rad/sec  roll  maneuver,  cases  8  and  9, 
the  a  s  o.l  has  the  smaller  mean  errors  in  both  the  x 
and  y  position  estimates  as  expected.  This  is  because, 
for  a  changing  intensity  profile,  more  emphasis  should  be 
placed  on  the  newer  measurements  which  are  more  representative 
of  the  current  intensity  pattern.  In  cases  10  and  11, 
where  a  1  rad/sec  roll  rate  was  used,  a  greater  performance 
enhancement  was  expected  for  a  =  0.1  than  had  been  seen 
for  the  previous  case,  as  the  intensity  pattern  is  varying 
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Table  VI.  Roll  Manuever  Evaluations 


at  a  faster  rate.  Additionally,  it  was  expected  that 
because  of  the  increased  motion  on  the  FLIR  image  plane, 
a  performance  degradation  would  be  observed.  However, 
upon  analyzing  the  results  these  expectations  were  not 
met.  In  the  x-direction,  the  mean  errors  did  in  fact 
increase  slightly  but  the  a  =  .05  case  shows  a  mean  error 
of  .01  pixel  less  than  for  the  ot  =  0.1  case.  In  the 
y-direction,  the  mean  errors  showed  a  slight  decline  with 
the  a  -  0.1  case  having  the  smallest  mean  errors.  At 
this  point  it  can  be  concluded  that  the  tracker's 
performance  may  be  enhanced  somewhat  by  a  judicious  choice 
of  a,  with  a's  in  the  ranges  chosen  being  appropriate 
for  the  trajectories  of  concern.  However,  the  symmetry 
of  the  intensity  profiles  on  the  FLIR  image  plane  affects 
the  tracker's  performance  more  appreciably  than  anticipated. 
This  problem  could  possibly  be  rectified  by  modifying  the 
means  of  extracting  the  target  position  offsets  from  the 
correlation  function  and  warrents  further  investigation 
(  see  Recommendations,  section  6.3) . 


5.12  Evaluation  for  a  Two-G  Pullup  Maneuver 


The  next  cases  were  designed  to  evaluate  the  performance 
of  the  tracker  when  the  target  performs  a  constant  2-g 
pullup  maneuver  in  the  inertial  y-direction  (trajectory  2) . 
Here  attention  is  focused  on  how  the  dynamic  trajectory 
effects  are  handled  by  the  tracker,  while  the  intensity 
shape  function  is  essentially  constant  (it  rotates  about 
its  principle  axis  slowly  to  remain  aligned  with  the  velocity 
vector.)  The  pullup  maneuver  was  initiated  at  t  =  2.0  sec 
and  contiuned  for  the  remainder  of  the  simulation.  Under 
this  situation,  the  effects  of  varying  the  smoothing 
parameter,  a,  on  the  tracker's  performance  were  evaluated. 
Additionally,  to  evaluate  how  the  filter  performance  would 
respond  to  a  relatively  small  deviation  from  that  achieved 
on  the  straight  crossing  trajectory  without  retuning,  the 
acceleration  time  constant,  and  the  strength  of  the  dynamic 


II*  Trajectory  2  (two-g  pullup)  Evaluations 


noise  were  left  unchanged  from  the  previous  cases .  Table 
VII  shows  the  statistics  for  the  2-g  maneuver  cases. 

Once  again,  varying  a  does  not  significantly  affect  the 
filter's  performance.  While  the  larger  a  produces 
smaller  mean  errors  in  the  x-direction,  an  almost  equal 
decrease  in  the  mean  error  is  seen  in  the  y-direction  for 
the  smaller  a.  Also,  without  changing  the  assumed 
target  correlation  time  or  increasing  the  Kalman  filter 
gain  through  increasing  o^,  the  filter's  estimate  of 
the  dynamic  target  position  trails  the  true  target 


position,  as  shown  by  the  negative  errors  in  the  yERR(+) 
columns,  but  the  filter  does  track  the  target  through  the 


maneuver.  Performance  enhancement  could  be  achieved. 


however,  by  allowing  and/or  to  be  adjusted,  as 
shown  in  section  5.13  for  the  5-g  case. 


5.13  Evaluation  for  a  Five-g  Pullup  Maneuver 


A  5-g  pullup  maneuver  was  selected  to  evaluate 

the  performance  of  the  filter  in  a  highly  dynamic 

tracking  environment.  The  effects  of  changing  the 

acceleration  time  constant  from  the  3.5  sec  value  psed 

for  the  benign  trajectories  to  a  correlation  time  more 

representative  of  a  dynamic  environment,  1.5  sec,  was 

evaluated.  Additionally,  the  strength  of  the  dynamic 

noise  was  increased  to  model  higher  possible  rms 

acceleration  levels  and  to  place  more  emphasis  (through 

the  filter  gain  calculations)  on  the  measurements  and 

less  on  the  dynamics  model.  The  value  for  found  by 

this  tuning  process  to  yield  the  best  performance  was 
2  4 

300  pixels  /sec  .  The  results  of  the  5-g  pullup  maneuver 
cases  are  shown  in  Table  VIII.  For  these  cases,  the 


plots  of  the  tracker's  performance  are  a  better  indicator 
of  the  response  of  the  filter  than  the  simple  temporal 
averages.  As  shown  in  Figure  C-14f,  the  filter  with  the 
3.5  sec  correlation  time  does  not  respond  well  at  maneuver 


initiation,  dropping  off  to  a  -2  pixel  error  in  Q.5  sec. 

Figure  C-15f  shows  the  filter  with  the  1.5  sec  correlation 
time  tracks  the  maneuver  initiation  much  better,  with  the 
y-error  only  dropping  to  -1.5  pixels.  However,  as  can 
be  seen  in  Table  VIII,  since  the  target  continues  on 
the  constant-g  pullup  trajectory  after  the  maneuver  is 
initiated,  the  longer  correlation  time  is  a  more  accurate 
portrayal  of  the  target  dynamics  during  this  phase  of 
the  trajectory  and  yields  a  filter  that  recovers  to  a 
better  estimate  of  the  target  position.  Thus,  a  target 
performing  jinking  maneuvers  in  the  dynamic  range  shown 
rather  than  a  simple  constant-g  pullup  would  be  better 
represented  by  the  shorter  correlation  time. 

5.14  Adaptive  Qfd  Estimation  Evaluation 

At  this  point,  the  self-tuning  Qf(^  adaptation 
procedure  was  evaluated  to  determine  if  reasonable  performance 
could  be  obtained  using  this  method.  It  is  not  expected 
that  this  method  will  perform  better  than  the  cases  in 
which  the  parameter  values  were  tuned  off-line  to  optimize 
performance  for  specific  trajectories.  However,  it*  is 
hoped  that  adequate  performance  across  a  wider  dynamic 
range  of  scenarios  can  be  achieved.  The  estimation 
procedure  was  initiated  at  t  =  0.5  secs.  This  time  was 
selected  so  the  filter  would  have  sufficient  time  to 
acquire  the  target,  where  the  Qf(j  value  is  purposefully 
set  to  a  large  value  to  prevent  the  filter  gains  from 
decreasing  to  early  in  the  tracking  phase.  Thus,  at 
t  =  0.5  sec,  the  filter  is  in  a  relatively  stable  tracking 
mode,  and  the  adaption  procedure  began  and  continued  for 
the  remainder  of  the  simulation.  The  performance  was 
evaluated  against  the  crossing  trajectory  and  the  2-g 
pullup  trajectory.  The  results  of  the  estimation  are 
shown  in  Table  IX. 


When  case  16  is  compared  to  cases  3  and  5,  it 
is  seen  that  in  the  x-direction  the  estimation  process 
has  a  substantially  smaller  mean  error  while  in  the 
y-direction  comparable  performance  is  achieved.  This  is 
not  surprising  since  a  conservative  tuning  was  used  in 
the  other  cases  to  reduce  the  transient  effects  in 
the  x-direction.  Case  17  illustrates  the  major  problem 
with  this  estimation  technique.  While  the  adaptive  filter 
will  converge  to  a  reasonable  estimation  of  the  states, 
under  benign  trajectory  conditions  it  reduces  its  gains 
to  a  point  where  it  cannot  respond  quickly  to  harsh 
trajectory  deviations.  Referring  to  the  Filter  vs. 

Actual  Error  Plot,  Figure  C-17b,  where  the  major  velocity 
change  occurs,  it  is  clearly  seen  that  while  the  maneuver 
is  initiated  at  t  =  2  sec,  almost  .5  sec  elapses  before 
the  filter  begins  to  respond  to  the  maneuver.  However, 
the  gains  are  not  increased  rapidly  enough  and  track 
of  the  target  is  lost.  Also,  note  in  the  x-direction. 
Figures  C-17c  and  e,  the  filter  overestimates  the  target 
position  due  to  the  velocity  decrease  in  that  direction; 
similarly  in  the  y-direction.  Figures  C-17d  and  f,  the 
filter  underestimates  the  target  position  due  to  the 
velocity  increase.  These  results,  consistent  with  the 
results  found  by  Harnly- Jensen  (6) ,  show  that  while  in 
cases  where  the  estimated  process  is  slowly  changing, 
this  estimation  technique  may  be  useful,  it  is  not  robust 
enough  for  useful  application  in  a  strongly  dynamic 
environment. 


5.15  Maneuvers  Out  of  the  x-y  Plane 


Trajectory  4  as  described  in  Chapter  II  was  motivated 
by  the  desire  to  evaluate  the  performance  of  the  filter 
when  the  target  turns  in  toward  the  FLIR  plane,  thereby 
projecting  three  distinct  and  separate  ellipsoids  onto 
the  FLIR  image  plane.  Thus,  substantial  trajectory  offsets 
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tre  combined  with  large  target  intensity  shape  changes , 
in  a  single  and  realistic  scenario.  However,  because  of 
the  short  length  of  the  simulation,  the  out-of-plane  angle 
is  very  small  unless  a  very  highly  dynamic  flight  profile 
is  used.  The  performance  against  a  target  flying  a  2-g 
out-of-plane  maneuver  is  shown  in  case  18.  The  resulting 
flight  profile  is  very  similar  to  the  2-g  pullup  maneuver 
previously  discussed.  Based  on  this,  trajectory  2  was 
modified  so  that  instead  of  initiating  a  2-g  pullup 
in  the  inertial  y-direction,  the  maneuver  is  performed 
in  the  minus  inertial  z-direction.  Thus,  the  target 
turns  in  towards  the  FLIR  plane.  Additionally,  a  roll 
rate  of  .25  rad/sec  was  used  to  simulate  the  rolling 
motion  associated  with  this  type  of  maneuver.  A  10-g 
maneuver  was  used  to  insure  the  three  separated  target 
ellipsoids  were  projected  onto  the  FLIR  plane,  yet 
because  of  the  geometry  of  the  trajectory,  this  is  not 
a  highly  dynamic  maneuver  as  seen  in  the  FLIR  image  plane 
and  the  filter  should  have  little  difficulty  tracking 
the  target  through  the  manuever.  The  results  of  these 
two  cases  are  presented  in  Table  X. 

For  reasons  previously  discussed,  the  results  of 
case  18  are  very  similar  to  the  other  2-g  trajectory 
cases.  In  case  19,  the  effects  of  the  hot  spot  symmetry 
on  the  correlator/Kalman  filter  performance  are  seen. 

For  this  trajectory,  when  the  target  turns  in  towards  the 
FLIR  plane,  three  distinct  and  relatively  symmetric 
ellipsoids  are  projected  onto  the  FLIR  image  plane.  The 
result  can  be  seen  in  the  reduced  mean  errors  in  the 
x-position,  again  emphasizing  the  dependence  of  accurate 
target  tracking  on  hot  spot  symmetry.  Also,  the  plots 
of  Figure  C-19a  and  c  show  that  when  the  velocity  in 
the  x-direction  is  reduced,  the  filter  slightly  overestimates 
the  movement  of  the  target  initially  but  quickly  recovers. 

The  final  evaluation,  case  20,  was  made  using 


Table  X.  Out  of  Plane  Maneuvers 


trajectory  3  to  test  the  performance  of  the  filter  when 
the  target  initiated  and  terminated  a  maneuver.  A  2-g 
pullup  was  initiated  at  t  =  2  sec,  and  at  t  =  3.5  sec 
the  maneuver  was  terminated  and  the  target  continued  at 
a  constant  velocity.  Because  of  the  transient  over  the 
last  1.5  seconds  of  this  simulation,  no  time-averaged 
statistics  were  calculated  for  a  tabulation.  Instead, 
a  discussion  of  the  performance  shown  in  the  plots  is 
given.  Figures  C-20c  and  e  show  very  little  effects 
of  the  maneuver  in  the  x-direction,  which  is  expected 
since  the  change  in  the  velocity  in  this  channel  is 
very  small.  Figures  020 f  and  f  show  the  filter  under¬ 
estimating  the  target  position  when  the  maneuver  begins, 
and  then  when  the  velocity  increase  is  terminated  at 
t  =  3.5,  the  filter  overestimates  the  target  movement. 
However,  after  a  second  transient  period  the  filter 
recovers  to  good  position  estimates. 


5.16  Summary  of  Test  Cases 


This  section  presents  a  brief  recapitulation  of 
the  20  test  cases  in  tabular  form.  These  cases  are 
presented  in  Table  XI,  where  deviations  from  the  * 
standard  truth  model  parameters  given  in  section  5.3 
as  well  as  the  filter  tuning  parameters  are  shown. 

Major  trends  observed  in  these  cases  as  well  as  conclusions 
drawn  from  these  trends  and  recommendations  for  possible 
performance  enhancement  measures  are  discussed  in 
Chapter  VI. 
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Table  XI.  Summary  of  Test  Cases 


Case 

Traj 

Pullup 

Rate 

Roll 

Rate 

NUMHS 

Tdf 

°df 

Alpha 

Misc . 

1 

m 

0 

B 

1 

3.5 

150 

.05 

2 

0 

B 

1 

EB 

150 

.05 

phase 

corr. 

3 

n 

0 

0 

3 

3.5 

150 

.05 

n 

m 

0 

0 

3 

3.5 

150 

.05 

phase 

corr. 

5 

i 

0 

3 

3.5 

150 

.1 

6 

i 

0 

0 

3 

3.5 

150 

.05 

SN=10 

7 

i 

0 

3 

3.5 

150 

.05 

AR=  2 

8 

n 

0 

.5 

3 

3.5 

150 

.05 

9 

n 

0 

.5 

3 

3.5 

150 

mm 

10 

n 

0 

| 

3 

3.5 

150 

.05 

11 

a 

ig 

3 

3.5 

■  - 

150 

mm 

12 

2 

2-g 

MM 

3 

3.5 

.  - 

150 

.05 

4 

13 

2 

2-g 

0 

3 

3.5 

150 

.1 

14 

2 

5-g 

0 

3 

3.5 

300 

.1 

15 

2 

5-g 

0 

3 

IS 

->00 

.1 

16 

a 

0 

0 

3 

3.5 

150 

.1 

ms 

17 

2 

2-g 

0 

3 

3.5 

150 

.1 

mm 

18 

a 

2-g 

0 

3 

3.5 

250 

.1 

19 

2 

10-g 

0 

3 

3.5 

150 

.1 

z-dir . 

20 

3 

2-g 

.25 

3 

3.5 

150 

.1 

149 


VI.  Conclusions  and  Recommendations 


6.1  Introduction 

This  chapter  presents  the  conclusions  drawn  from 
this  research  project  and  presents  recommendations  into 
other  research  efforts  which  could  be  pursued  to  enhance 
the  performance  of  the  correlator/Kalman  filter  and  the 
realism  of  the  truth  model  for  performance  evaluation 
purposes .  v 

6.2  Conclusions 

a.  Data  Processing  Algorithm.  The  data  processing 
algorithm  which  generated  the  estimated  intensity  function 
for  use  as  the  template  in  the  correlation  algorithm  was 
shown  to  perform  well  in  this  research.  With  this  method, 
almost  identical  performance  was  achieved  in  both  the 
single  and  multiple  hot  spot  cases.  This  is  in  direct 
contrast  to  the  Harnly-Jensen  EKP,  which  experienced 
difficulty  when  the  target  intensity  function  was  not  of 
the  assumed  bivariate  Gaussian  form.  The  extra  computational 
loading  incurred  with  implment.ing  this  algorithm,  which 
makes  no  assumptions  about  the  intensity  function  shape, 
is  well  justified.  However,  it  is  possible  that  the  bias 
which  the  tracker  exhibited  could  be  caused  by  the  algorithm's 
reconstruction  of  the  target  intensity  function.  A 
discussion  of  a  possible  research  approach  to  determine 
the  cause  of  this  bias  will  be  deferred  until  the 
recommendations  section.  Varying  the  exponential  smoothing 
parameter,  alpha,  to  address  changing  target  shapes  did 
not  significantly  enhance  or  degrade  the  performance  of 
the  tracker.  An  alpha  in  the  range  of  0.05  to  0.1  consistently 
resulted  in  acceptable  performance. 


b.  Correlation  Methods.  Based  on  the  results  of  the 


analysis  of  the  four  correlation  methods  and  a  tracker 
evaluation  of  two  methods,  the  FFT  method  clearly  yielded 
the  best  tracking  performance  when  implemented  with  the 
Kalman  filter.  This  method  performed  well  in  both  the 
single  and  multiple  hot  spot  cases.  However,  the  errors 
observed  from  the  correlator/Kalman  filter  were  closely 
tied  to  the  symmetry  of  the  target  intensity  pattern  as 
projected  onto  the  FLIR  image  plane  which  directly  relates 
to  the  chosen  method  of  deriving  the  peak  offsets  from 
the  correlation  function.  In  the  asymmetric  case, the 
center  of  mass  calculation  which  was  used  to  approximate 
the  peak  of  the  correlation  function  gives  biased  results 
which  are  readily  apparent  in  the  tracker's  performance. 
Alternatives  to  the  center  of  mass  method  will  be  considered 
in  the  recommendations  section. 

c.  Kalman  Filter.  The  first-order  Gauss-Markov 
model  chosen  to  represent  target  acceleration  provided 
acceptable  tracking  performance,  and  thus  the  compuational 
savings  associated  with  utilizing  a  linear  filter  over  an 
extended  Kalman  filter  or  other  non-linear  filters  were 
realized.  The  filter  proved  to  be  robust  enough  to  track 
a  benign  target  and  a  five-g  target,  which  at  the  ranges 
considered  is  a  very  dynamic  maneuver,  without  changing 
the  acceleration  time  constant  and  with  only  a  slight 
increase  in  the  dynamics  driving  noise.  However,  better 
performance  was  realized  when  the  acceleration  time  constant 
selected  was  more  representative  of  the  maneuver  being 
tracked.  Thus,  the  concept  of  implementing  a  correlation 
algorithm  in  cascade  with  a  linear  Kalman  filter  in  a 
dynamic  environment  is  a  viable  alternative  to  other 
non-linear  approaches. 


technique  did  not  prove  robust  enough  to  be  used  throughout 
an  entire  simulation  in  a  very  dynamic  environment. 

However,  as  detailed  by  Harnly  and  Jensen  (6) ,  this  routine 
does  contain  indicators  which  could  be  monitored  to  detect 
when  the  target  initiated  a  maneuver.  Based  on  these 
indicators,  the  gain  values  within  the  filter  could  be 
changed  to  other  preselected  vaules,  as  an  alternative 
to  implementing  more  computationally  burdensome  maximum 
likelihood  estimation  techniques  or  multiple  modeling  schemes 
to  provide  the  desired  adaptation  (13:  Chapter  10) . 

e.  Harnly  and  Jensen  EKF .  Assuming  the  divergence 
problem  which  appeared  in  the  simulations  in  this  research 
could  be  readily  solved,  the  Harnly- Jensen  designed  EKF 
performed  well  in  the  single  hot  spot  case  where  the  target 
intensity  function  was  well  represented  as  bivariate 
Gaussian.  However,  the  filter  did  not  perform  well  when 
the  target  intensity  pattern  was  not  well  represented  as 
bivariate  Gaussian,  as  expected.  While  this  method  may 
not  readily  adapt  from  the  single  to  the  multiple  hot  spot 
case,  the  performance  in  the  single  hot  spot  case  was 
very  similar  to  the  correlator/Kalman  filter  without  the 
increased  computational  loading  incurred  by  using  the 
data  processing  algorithm  of  this  thesis.  Therefore,  for 
the  single  hot  spot  case,  such  as  an  air-to-air  missile 
where  information  as  to  the  target  type  could  be  readily 
obtained  from  the  acquisition  source,  this  may  be  the 
preferred  filter. 

6.3  Recommendations 

a.  Data  Processing  Algorithm.  A  possible  cause  of 
the  bias  observed  in  the  correlator/Kalman  filter  is  the 
data  processing  algorithm  that  generates  the  target  intensity 
shape  function.  To  determine  if  this  algorithm  is  the  cause 


of  the  bias,  a  comparison  between  this  research  and  the 
research  conducted  concurrently  by  Lieutenant  Mark  Kozemchak, 
who  used  the  same  data  processing  algorithm  in  an  extended 
Kalman  filter,  should  be  made.  If  the  same  characteristic 
bias  is  noted,  a  further  confirmation  could  be  obtained 
by  replacing  the  estimated  target  intensity  function  with 
the  true  target  intensity  function  in  the  correlation 
algorithm.  If  the  bias  is  noted  in  the  Kozemchak  thesis 
and  replacing  the  estimated  intensity  function  with  the 
true  intensity  function  removes  the  bias  then  the  data 
processing  algorithm  would  have  to  be  analyzed  to  determine 
where  a  phase  shift  in  the  transformed  domain  could  occur 
which  would  cause  this  effect.  If  the  bias  is  not  observed 
in  the  Kozemchak  thesis,  then  the  bias  is  almost  certainly 
due  to  the  correlation  method. 

b.  Correlation  Methods.  The  center  of  mass  calculation 
used  in  this  research  as  an  approximation  to  the  point  of 
maximum  correlation  yields  a  bias  when  the  intensity  pattern 
is  not  symmetric.  This  effect  noticeably  degraded  the 
performance  of  the  tracker.  An  alternative  formulation  could 
be  developed  whereby  the  center  of  mass  calculatio/i  is 

used  to  determine  the  approximate  peak  of  the  correlation 
function  and  then  a  precise  peak  finding  routine  would  be 
employed  to  provide  a  more  precise  estimate.  (The  reason 
for  initially  using  the  center  of  mass  calculation  is 
to  get  in  the  vicinity  of  the  peak  location  prior  to 
implementing  the  precise  peak  finder.  This  should  help 
avoid  locking  onto  local  peaks  as  a  basic  peak  finder  might.) 

c.  Kalman  Filter.  The  filter  showed  enough 
robustness  to  track  the  targets  of  interest  with  only 
small  changes  to  the  filter  parameter  values.  To  achieve 
high  precision  performance  over  a  wide  dynamic  range,  this 
filter  could  be  implemented  in  a  multiple  model  algorithm 
(13: Chapter  10)  in  which  a  small  number  of  Kalman  filters 


with  varying  parameter  values  would  be  capable  of 
adequately  modeling  the  dynamic  profiles  of  concern,  as 
an  alternative  to  adaptive  estimation  of  in  a  single 
Kalman  filter.  Initial  investigation  of  this  concept 
conducted  by  Flynn  (6)  proved  somewhat  disappointing, 
but  is  possibly  worth  further  exploration. 

d.  Truth  Model.  The  truth  model  changes  made  in  this 

research  resulted  in  a  fairly  accurate  portrayal  of  the 

real  world  processes  of  interest.  The  simulation  is 

structured  so  that  changes  from  one  trajectory  to  another 

and  from  the  single  to  multiple  hot  spot  case  are 

readily  made.  The  truth  model  simulation  could  be  enhanced 

by  modeling  the  cases  where  the  target  fuselage  is  between 

the  intensity  function  and  the  FLIR  image  plane,  thereby 

either  blocking  out  completely  or  blocking  out  portions 

of  the  intensity  function.  Realistically,  when  the  target 

is  receding  from  the  tracker  location  the  entire  infrared 

source  will  be  exposed  to  the  FLIR  image  plane  resulting 

in  a  hotter  target  while  the  converse  is  true  for  an 

incoming  target.  By  varying  the  value  of  the  intensity 

based  on  considerations  such  as  these,  the  realism  of  the 

* 

truth  model  would  be  improved.  The  unit  vectors  which  are 
currently  calculated  for  the  multiple  hot  spot  simulation 
could  be  used  as  the  foundation  upon  which  these  more 
precise  models  could  be  based. 
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Intensity  Centroid  Projection  Model  for  Multiple  Hot  Spots 

In  this  appendix ,  the  equations  required  to  implement 
the  multiple  hot  spot  projection  model,  described  in 
section  2.5,  are  detailed. 

As  depicted  in  Figure  13,  a  unit  vector  in  the  eza 
direction  can  be  defined  by 

e  =  cos  a  k  -  sin  a  i  (A-l) 

ZOL 

where 

i,  j,  k,  represent  unit  vectors  along  the  inertial 
x,  y,  and  z,  axes  respectively. 

To  determine  the  direction  of  a  unit  vector  in  the 
e^  direction,  first  rotate  about  the  inertial  y-axis. 

The  coordinate  transformation  is: 


Now  rotate  about  the  e„„  axis  to  obtain: 


Substituting  (A-2)  into  (A-3)  yields 


Performing  the  indicated  multiplication  where  efl  in 

py^ 

Equation  (A- 4)  will  henceforth  be  referred  to  as  e^,  see 
Figure  13,  the  desired  vector  is 

e^  =  (cos  a) (-sin  B)i+cos  3j+(-sin  B) (sin  a)k  (A-5) 

* 

The  relationship  between  these  unit  vectors  and  FLIR 
plane  unit  vectors  is 


eB  ey  FLIR 

■A.  _ 

®za  =  ~ex  FLIR 

With  the  e„-e„„  plane  translated  in  inertial  space 

p  zu 

to  coincide  with  the  aircraft  COM,  Figure  14,  and  since 
the  velocity  vector  is  assumed  to  lie  along  the  aircraft 
centerline,  a  unit  vector  out  the  nose  of  the  aircraft  can 
be  determined: 
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(A—  6 ) 


l'-- 


B 


n 


N 


1  0? 

*  \ 

r.’“ 

I 
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u 


« 

. 

i 


'HX 


=  V+V+Vzk 
M 


where 


v  ,v  , v 
x'  y'  z 


-  refer  to  velocity  components  in  the 
inertial  frame 


eHX  -  unit  vector  along  aircraft  velocity  vector 
I  vH(Vx+vy+Vz>J5 

Since  eHX  will  always  pass  through  the  aircraft  COM, 
this  unit  vector  is  used  to  form  the  first  axis  of  a 
coordinate  system  referred  to  as  the  H  frame,  with  its 
origin  at  the  aircraft  COM. 

To  determine  the  orientation  of  the  second  H-frame 
axis  the  following  cross-product  was  used 

vxj 


This  cross-product  produces  a  vector  normal  to  v  and  j . 
Explicitly,  f 


k 

v 


-v2i+vxt 


(A-7) 


This  vector  is  normalized  to  produce  a  unit  vector  in 
the  direction  of  the  second  H-frame  axis; 


~vziH~vxK 


(A-8) 


Note  that  this  axis  will  always  lie  in  the  horizontal 
inertial  plane  thus  the  H,  or  horizontal,  frame  notation. 
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To  find  the  direction  of  the  third  H-frame  axis,  cross 
the  vectors  which  define  the  first  two  H-frame  axes: 


v  v  v 
x  y  z 


‘  vxV-(vx+vz>J+vyvz* 


(A- 9) 


"Vz  ° 


Equation  (A— 9 )  is  normalized  to  produce  a  unit  vector 
in  the  third  H-frame  direction: 


vxV~  (vxtvz)^ Hv 

Evx+''z> 


(A-10) 


Thus,  a  coordinate  system  relative  to  the  velocity 
vector  is  defined,  see  Figure  15. 

For  trajectories  where  a  roll  about  the  "eHY  axis 
is  desired,  the  two  hot  spots  located  on  the  e'„v  axis 
will  move  out  of  the  e„  -e„-,  plane,  whereas  the  hot  spot 

Ma  H  z  ^ 

1,  as  defined  in  Figure  16,  will  remain  along  the  eHX  axis. 
To  determine  the  location  of  hot  spots  2  and  3 ,  a  body  axis 
with  the  x-axis  out  the  aircraft  nose,  the  y-axis  out  the 
right  wing,  and  the  z-axis  out  the  belly  is  used.  As 
depicted  in  Figure  17,  the  direction  of  hot  spots  2  and 
3  can  be  determined  by 


=  cos  $  eHV+sin  e 


(A-ll) 


where 


<Mt0)  =  0 
$(t)  =  wt 
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An  example  is  used  to  demonstrate  how  these 

coordinate  frames  are  used  to  project  the  locations  of 

the  ellipsoid  centers  onto  the  FLIR  image  plane. 

Referring  to  Figure  18,  the  offset  distance,  6,  along 

the  e_v  axis  can  be  projected  onto  the  translated  "ea 
BY  p 

axis  by: 


68T  ^BY  '  e8-l 


(A-12) 


Performing  the  dot  product  in  Equation  (A-12)  yields 


<SQm  =  <Sf(dos  <J>)  (-v„)  (cos  a)  (-sin  8)  +  (cos  <j>)  (v  )  (-sin  8) (sin  a) 


+  (sm  <j>)  (v  v.)  (-sin  8)  (cos  a)  -  (v„+v  )  (sin  4>)  (cos  8) 


+  (sin  d>)  (v..  v„)  (-sin  8)  (sin  a) 


where 


A  =  denominator  of  Equation  (A-8) 

B  =  denominator  of  Equation  (A-10) 


In  the  e  direction,  the  projection  is 

ZOL 


6zaT  6l-eBY’eza3 


(A-14) 


or  explicitly. 


6zctT  =  ^H003  4>)  (~vz)  (-sin  a)+(cos  <{>)  (vx)  (cos  a) 


+  (sin  <j>)  (v  v  )  (-sin  a)  +  (sin  <j>)  (v  v  )  (cos  a) 

_ _  X-  Y_  .....  _  Y  z 


(A-15) 


The  equations  for  the  projection  of  the  hot  spot 

located  along  the  env  axis  onto  the  translated  'e„-'e 

ox  p  za 

plane  are: 

6gT  =  6C®bx*®bJ  =  6PVx)  *“sin  2)  (cos  a)  +  (v  )  (cos  B) 


(v  )  (-sin  B)  (sin  a)' 

+  g _ 


(A-16) 


6zaT  =  6&BX*®za]  =  <$FVx)  (~sin  a)  +  (V  <cos  “>1 

L  |v|  J 


(A-17) 


The  final  step  is  to  convert  the  offset  distance 
on  the  translated  “e^  -"e^  P-^ane  into  distance  on 
the  FLIR  image  plane.  The  hot  spot  displacements  in 
the  translated  eQ  -emplane  are  normal  to  line  of 

p  ZU 

sight  from  the  FLIR  image  plane  and  with  the  range 
known  from  the  trajectory  model,  the  angular  displacement 
of  the  hot  spots  will  be  used  to  approximate  linear 
distance  on  the  FLIR  image  plane.  The  geometry  in  the 
"eQ  direction  is  shown  in  Figure  A-l . 

P 


162 


B  IP 


H 


h 


center  of  FLIR  image  plane 


Figure  A-l.  Projection  onto  the  FLIR  Plane 

Equation  (A- 18)  gives  the  approximate  displacement  in  the 
e^,  direction,  6^,  which  coincides  with  the  YFLIR 

direction,  in  radians: 


<5g  =  tan  9^;8Di<SBT  (A-18) 


This  distance  is  converted  to  pixels  by  dividing  by 
.00002  and  added  to  the  coordinates  of  the  aircraft 
COM  in  the  FLIR  plane.  Thus,  the  offset  distance  in 
the  YpLiR  <*irecti°n  for  each  hot  spot  is  determined. 

The  offset  distance  in  the  xFLIR  direction  is  determined 
in  the  same  manner  except  the  distance  must  be  subtracted 
from  the  aircraft  COM  since  e„„  =  {-)&„  _r  to • 

ZCt  X  r  L1K 
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Derivation  of  Qfd  for  the  Kalman  Filter,  Chapter  III 

The  derivation  of  Q^,  Equation  (3-12),  for  the  filter 
state  equation  which  was  briefly  described  in  Chapter  3 
will  be  fully  detailed  in  this  appendix.  From  Chapter  3, 
$.ff  Gf,  and  Qf  are: 


(B-l) 


where 
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Thus,  Qfd  may  be  evaluated  using  (12:171) 


Qfd  =  tf  i+1£f(t.+1,T)Gf(T)Qf  (T)GT(T)^(t.+2,x)dT  (B 


Performing  the  matrix  multiplication  inside  the  integral 
of  Equation  (B-4)  yields:- 


T  T 

£f-f^f-f^f  = 


A2Q  0 
1  i 


ABQ  0 

i  l 


0 

ABQ 


A2Q 


?  2 


ABQ 


l  l 

0  ABQ 


2  2 


0 

B2Q  0 
1 

b2q 


2  2 


1 1 

0  D  2' 


ACQ  0 

l  l 


BCQ  0 

l  l 


0 

0 

0 


ACQ 


2  2 


0 

0 


0 

0 

0 


BCQ 


2  2 


0 

0 


where 


A,  B  =  are  as  in  Equation  (B-l) 


-At 


df 


D  =  -At 

e  T 
xaf 


ACQ 


x  1 


0 

BCQ 


x  1 


2  2 


0 

ACQ 

0 

BCQ 


2  2 


2  2 


c2q 


X  1 


0 

0 

0 


C2Q 


2  2 


0 

0 

0 

0 

0 

0 


0 

0 


d2q 


Q  -Q  =  matrix  elements  of  Equation  (B-3) 


Since  the  integral  of  the  matrix  shown  in  Equation 
(B-5)  equals  a  matrix  of  integrals  of  each  element, 
the  remaining  demonstration  of  the  computation  of  — fd 
will  follow  the  integration  of  the  11-element  of  Equation 
(B-5) .  Substituting  for  A  and  Q11  yields : 


<4  “i. 


<Taf)  -i  +  2  2  4 

«  Tdf 


2At  +  2At  e~-  +  1-  2i|^-  + 

Tdf  Tdf  df  df  df 


Thus, 

i+1  -  32  i+l  2 

t/  A2(T)Q11(T)dT  =  {2T3f  02f)  ^  (t.+1-  )2dT 

X  1  « 

Tdf 

ti+1  ti+1  -(t  -T)  ti+1 

-t/  2(ti+1-T)dT  +  J  2(t.+1-t)  e'^d  +  J  dr 

^7“  df 


-  f  ^‘W^dx  +  /1+1g2(ti+l~T)dT 

1  Tdf  1  Tdf 


(B-6) 


After  performing  the  indicated  integrations  and  combining 
terms,  the  result  is: 


fci+l 


/  A2(T)Q.,  (T)dT  =  o’  (2)  (T,f)  (At)3  -  (2)  (T,.)2(At)2 


'df  '  df' 
3 


(4)(T  )3(/St)(i|i-)  +  (2)(Tdf)3(4t)  ♦  (Tdf)4(i|^)  +T4f 


(B-7) 
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The  remainder  of  the  terms  of  Equation  (B-5)  are 
evaluated  in  a  similiar  manner  with  the  results  being 
as  expressed  in  Equation  (3-12)  . 
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Appendix  C 


Plots  of  Tracking  Errors 

This  appendix  gives  the  sequence  of  plots  described 
in  Chapter  5.  The  figures  are  numbered  so  as  to  correspond 
directly  to  the  case  numbers  used  in  Chapter  5,  i.e. 

Figures  C-2a  thru  C-2j  are  the  plots  which  correspond  to 
case  2  in  Chapter  5.  For  a  description  of  the  truth  model 
and  filter  paramters  refer  to  the  appropriate  table  in 
Chapter  5  or  the  summary  table  which  is  given  in  section 
5.16.  (Note:  In  order  for  the  case  and  figure  numbers  to 
correspond.  Figure  C-l  is  not  used} .  For  the  cases  where 
the  filter  tuning  plots  are  not  shown,  the  tuning  employed 
was  similar  to  case  1  for  single  and  case  3  for  multiple 
hot  spot  targets. 
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Figure  C-4a.  Case  4 
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The  performance  plots  for  this  case  were  similar 
to  the  plots  shown  for  case  3  and  thus  are  omitted. 


Figure  C-5.  Case  5 
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Figure  C-lOe.  Case  10 
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Figure  C-lOf.  Case  10 
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The  performance  plots  for  this  case  were  similar 
to  the  plots  shown  for  case  12,  and  thus  are  omitted. 
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Figure  C-13.  Case  13 


Figure  C-14h.  Case  14 


FILTER  VS  RCTUflL  ERROR  ( Y-POS I T ! ON  ) 


TIMEi SEC  ) 


.00 


( si3'xid  )yojj"a3 


Figure  C-15d.  Case  15 
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Figure  C-17a.  Case  17 
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TIME 


The  performance  plots  for  this  case  were  similar  to 
the  plots  shown  for  case  12,  thus  they  are  omitted. 


Figure  018.  Case  18 
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Appendix  D 

Computer  Software  (Correlator/Kalman  Filter) 


This  appendix  contains  the  Fortran  source  code  for 
the  implementation  of  the  algorithm  of  Figure  1.  The 
program  also  contains  the  truth  model  described  in 
Chapter  2  where  the  trajectory  can  be  generated  either 
with  the  model  internal  to  this  program  or  using  the 
trajectory  program  given  in  Appendix  E.  (Note:  For  the 
multiple  hot  spot  model  the  program  given  in  Appendix  E 
is  used) .  Finally,  this  program  contains  the  routines 
to  calculate  and  plot  the  tracking  errors  of  the  algorithm 
which  are  presented  in  Chapter  5  and  Appendix  C.  The 
program  was  written  for  use  on  the  CDC  Fortran  IV  compiler 
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Uuo  CUU'UUUuUCUUOUU  UUUUOUUt_'UoUuUOUU(_-  u  u  u  u  uou 


G"A*  ?*  A I  r*  74/74  ?t=i  prn,,D  FT  f  4.^-,SG4  in 


c  k  nr  am ic  l  ca’I'  ■. 

CE 

XFHE2  L  T  (Hr  SOUA'F  t.'F  THr  X-ME 

ri  n  T  JT.  THAT  XfME  A'.D  XFVP?  A?  F.  A3  3 AYS  WHICH  A3  E  01 MFVr IC NED  T1 

EAL  XFVF<4  ,XF‘  E2(  4,20  3  >  ,r:*E<4 ,210  > 

EAL  C '  ME.  2  T 4  ,2  s.  3  )  »  XF  P MS (  “  *  2  ?  0  )  •  *  FMP3  (  4  .2'’  1  > 

EAL  CMMW3<4',2C  3  )  ,C?  Mp  ■  f  4  ,2C  C  ) 

BE  2X2’.'  THE  ?T*r.T  ISW  ! EACH  :  S  USED  F'R  THE  X 
OI-ECTTON  WHILE  THF  SECOND  POU  IS  FOR  THE  7  DIRECTION 

CflME  IS  THE  E°ROF  I M  HI  PREDICTD  LOCATION  CF  THE  CE'JTRDID  AT 
A  PARTICULAR  MINUS  TIve  COMPAND  TO  THF.  TRUTH  MODEL 
CNMF2  IS  THE  SQUARE  OF  C'iME 

NOTE  AGAIN  "HE  DIMENSION  OF  CNME  AND  CNMf[2C 

XFPF  IS  r  HE  ERROR  BETWEEN  THE  UPDATED  DYNAMIC  LOCATI  ON  AT  A 
PA  • 7 ICULAF  PLUS  TIME  AND  THE  TRUTH  MODEL  true  DYNAMIC 
XFPE2  IS  THE  SOU  APE  OF  X F D E 

NOTE  THE  DIMENSIONALITY  OF  X-3E.XFPF2  FOR  THE  SAME  REASONS  AS 
°  E AL  XFP E ( 4,200 )fXFPE 2(4,200  > , CN3 E C * » 20 0 > 

•’EAL  CN3 E2  (  4  ,2CQ  ) 

PEAL  XFPM3  (*  ,2  0  0  )  *  XFPP3 C  4  »2 0  Q  )  »  C NPMS  C  4  « 20  0  >  ,  Cf’PP".  C  4 ,200  ) 

''EAL  PFP  3  T  (  v  ,200  >,PFMS~<  '*  ,230  ) 


CNPF  IS  THE  CE\TFGID  E  R  3  0 1  A  Y  THE  PLUS  T * ”E 
F I L  r  E S  DATA  STRUCTURE  S 


DHI F  13  THE  STATE  TRANSITION  MATRIX  FC-D  THE  KALIAN  FIL'ER 
-SEE  SUBROUTINE  FILLER 

QFO  10  THE  PE  SUL "  OF  "HE  INTERNAL  TER  H  IN  THE  PROPAGA  ION 
-CF  ’HE  COV  MATRIX  EE  SUBROUTINE  PF OPF 
PFP  IS  THE  FI L T E c S  COVARIANCE  MATRIX  PLUS-  AFTER  INCORPORATION 

-CF  A  ME ASUKEMEN" 

PFM  13  THE  FELTEFS  COV A 3  I ANCE  MATRIX  MIMJS  AFTER  PPOPAGA"! ON 
-BUi  PRIOR  TO  MEASUREMENT  INCORPORATION 
XFP  IS  THE  FILTE-  STATE  VECTOR  PLUS 

XFM  IS  thf.  FILTER  STATE  VECTOR  MINUS 

'EAL  °HI F  < d  »  ),QFD(‘  ,R)tCFP«R,3>,PFM(R,R»,XFP(a»,XFMC?),’IME 


Z  IS  THE  KALMAN  FILTER  MEASUREMENT  VECTOR 

REAL  7 (64 ) 


DIMENSION  NAME (45  I 


ARRAY  NAME  STORES  THE  PLOT  TITLES 


DATA  MAMEd ) /4GHFILTER  V  ACTUAL  ERROR  CX-POSI’ION)  / 

DATA  NAME  <  5) /4C  HF  TL  TER  VS  A  C  T  J  A  L  ERROR  (Y-POSITICN)  f 

DATA  NAME  <0)/4  0HESTI  MATED  X-*»IVU>  POSITION  (♦/->  SIGMA  / 
DATA  i«  AML  C  1  3  >  /  4C  HEST  I  MAT  ED  Y-MINUS  POSITION  (♦/->  SIGMA  / 
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0G°  AM  MAI?.  74/74  0PT  =  1  PMDM3  pf»t  4.,?4.5<34 


OA'A  NAMECl  ')/4jHESTIMATE0  v-°LU3  303ITI0N  (♦/->  ~  IGMA  / 

DATA  NA*.EC2l  >/40HEST  I  MA'FD  Y-PLUS  sp>  TIG*1  (♦/-)  ^ICMA  / 

DATA  NAME < 25  I /5C HES  ’[MATEO  X-MtNVL  CENTROID  POSITION  {♦'-)  IG« 
♦  / 

DATA  NAME  t  3;)  )/ 3 3  HE ST  I  MATED  Y-MINUS  CENTROID  POSITION  (+/-)  IGM 
♦  / 

DATA  NAME:<35)/E>rHEs:  IMA^EO  X-^lUS  CENTROID  POSITION  <♦/->  ,'’GMA 
«■  / 

DA  ’A  NAME  C  40  )  /bOMES  r  I  MATEO  Y-PLUS  CENTROID  PPSITION  t*/-)  S’GMA 
«■  / 

C 

c 

c 

DATA  Nr#/ 24  *  24  / 

C 

c 

C  INI rI AL  IZE  THE  F I L T EP  '  DATA  3 T R UCTURP " 

C 

xvel~o=- iocs . 

YVEL'0=:  . 

Z  VE  L  T  0=  0  . 

PT=(1./3g.) 

ASP-? .0=1. 

$1 GM  3 -SORT (2  .  ) 

C 

C  FOP  A  CNF  HOT  SPOT  SIMULATION  SET  NUMH3=1  " 

f.UMH  -  =  3 

WR  I  T  E(  6 »  5  76  >  i.UMHS 

vL*  57C  FORMAT  (l  >  »*  NUMBER  ~.F  HOT  S30r 3  =  * *  14 > 

C 

C  IF  USING  THE  EXTERNAL  TRAJECTORY  set  TPAGEN=2 

R  AGF.fi  =1 

:F<T^AC»EN.EQ.2>WPITEC6»5F1I  a 

551  FORMAT ( I  X  » *  EXTERNAL  TRAJECTORY*) 

c 

c 

C  SELECT  the  P  *•  I  *jt  I  ?]  THE  EXTERNAL  TAPE  TO  START  THE  PON 

C 

IF  (  TRAGEN.-  E.2IG0  "•  503 

C  3  TP.  UN  13  THE  PAS  A  ME  ’ER  UHICB  SErS  THE  S^AftT  PQlN" 

3  TRUE  - 1 

WR  I  T  F  <  b  *  E»  ‘3  2 )  •*•  T  R  U  'i 

552  FORMATClXt*  -UN  STARTED  A!  *,I4> 

5hi  CONTINUE 

C 

C  "HE  FOLLOWING  £3  A  LIST  CF  THE  CORRELATION  METHODS  USED 

C  CCR-L  =  I  FFT  METHOD 

C  C0PPL=2  CHASE  CORRELATION  Mr* BOD 

C  CDRRL=3  DIRECT  METHCO  2-LEVEL  QUANT  I ? AT  I  0*1 

C  C0RRL=4  DIRFCT  METHOD  6-LEVEL  QUANTIZATION 

C 

CORr L=I 

-  C 

WR  I  TE<  6*564  ICO? ?L 
5b*  FGRMAT<1X»*C.  PPF.  LATCr=*tT4) 

C 

C  rF  PLOTS  ARE  DESIRED  SET  I P  L  0 r  = 


2 


AM  MAIM 


74/7*  0PT=1  PMOM0 


FtN  4.fi«-5S4 


IPLHTrl 

G 

WRITE(6*41) 

41  FOp  MAT(  /»!>♦*  CASE  000'*) 

CM 

C 

C  'S.T  THE  CORRELATOR  THRESHOLD 

'HRE  H=.3 
C 
C 

C  :F  THE  INTERNAL  T  R  A  JEC1  CF  Y  15  BEING  USED  TRATE  SETS  T  HF 

C  DESIrED  G  MANEUVER 

C  A  T  Ur  N  RATE(TPA'C)  =  -015S  YIELDS  A  ?-G  TURM 

C  A  rU'''(  PATE  =  .mS  YIELDS  A  !3-G  TURN 

C  A  TU'N  RATE  =‘.1S6  YIELD'  A  2Q-G  TJR'J 

fR.AT.i  .  0  1?G 
WPITE<&,55C>  nAE 

5~L‘  FOB  MAT  (1  V » *  THF  TURM  PATE  I.«  *»Fa.4//) 

C 

C  T OF  IS  THE  FILTER  ACCELEF A T I r N  TIME  CONSTaM 

A  T  A  TDF/3.5/ 

WP  ITE ( 6 1*3 1 )  T UF 

31  F0RMATI1X,*  T0F  =  *»£14.6> 

C 

C  the  FILTER  MEASUREMENT  CCVARIAYCE  MATRIX  CPFIL)  IS  DEFINED 

C  ACCORDING  TO  THE  CORRELATION  METHOD  STATISTICS 

DATA  ‘FIL/.E  0 4  35  *  0. * C .  , .OCS'S/ 

C  IF(Ci PRL.EQ.2) 3FIL(1 *1 )=.472 

C  IF(CORRL.EQ.2)JFIL<2«2)=.374 

CF<C0RPL.ED.3)RF!LC1*1)  =  .-J?4? 
rF  (CO.RRL  *EQ«  3  ) ?  F IL  C?  »2  )  =  »00S4() 

I F  C  CORRL  «EQ»  4  >!  F  l  L  ( 1  *  1  >  =  .0  0  7  35 

:FCC0RRL«EQ.4)r  FILC2*2>=.0071  A 

C 

C*********************************************************************** 

c* *  :  u  i  '  i  a  l  i  ?  a  t  r  o  t:  ** 

O******************************************  ******** 

c 

CALL  PA  VSE' (12345) 

54321  WRI  TE(G»37':  7) 

37  7  F0P*’ArC  lX*»GAU$SIAf.  TARGET  COVARIANCE  VALUE  *  ) 

- E AO (5  *50  0  )  COV 
5£C  FORMAT (F6*2) 

T.F(E  •,F<5).f  E.f})  GO  TO  5421 
HRITEC6* J7* l) 

3  7r l  FOR  MAT ( 1 X*  *  VUM8ER  CF  ZE°3ES  TO  RAD* ) 

■EADC5*561)  UZ 
56  1  FCRT'A"  (  12  ) 

NZM=25-riZ 

WP  I  TE  (  6  ♦  3  7  '•  2  ) 

37  2  FOPMATd  X»*  -  UMBER  CF  FRAME'*) 

PEADC5»5G?)  NFRAMET 
56  FOR  MA  r { I  3  > 

WRI TE  (6  *4023  ) 

4023  FORMAT!  IX**fU«BER  CF  S I MULA  T I  '  \» '  *  ) 

PEA0(5*5F1)  N»UMS 
WRI  :E(G»37»3) 


^oo 


3GS  A  M  MAIN  7A/74  OPT  =  l  PuDwa 


FTN  A.P4-5G* 


37  3  'FORMAT*  X,*ALPHA  FCF  SMCG'HINGO 
'EA0(5»bbC )  AL-  HA 
3  7  A  W* I  TEC £.3 7  -1) 

37  5  FORMAT t  i  X*  •  MJKHE°  CF  HIGH  FEEQ  COMBINE*'  T$  TO  ZEPO* > 
REAOCStEGl)  r:F5EQ 
I  SF  =1  4-?iFRtQ 
IEF^I.2**  FREQ 
WRITECG»3  7*  !.  ) 

3  7  ‘  ?  FORMAT  C  1  X  *  *  i  EP  J  T  MEA3UUFME  NT  -:*3fn  “  A~  T  Af]CE  *  ) 

P.EAUC5.560)  VAR  M 

5t  2  FOP  MAT  (  2FG  »?;) 

P  EAO  C5  »5  p  31X0 
H  R  I T  E  t  G  •  3  7  R  7  >  X  O 

3 7  7  FOR  MA  TC I  X  *  *  I  *  I i I AL  X  POS I T I  ON* . El  6. 7 ) 

5f.  3  FORMAT  CF 10  ,2) 

'  E AO ( 3  *3  03  )  Y 
'  UR  I  T  E  <  6  »  3  7?  S  J  Y  0 

37. R  FORMAT  Cl X»*If  i riAL  Y  PC 3! TJ ON* * E 1 6 . 7 > 

EAUC3,5G3>/0 
WR I  TEC  6, 3 7 ?)7r 

37??  FOPMAT  CIX»*IMTIAL  Z  PCSI*TI^N*»E16»7) 


C 

CALL  riITF(TAF«VAROFtVA»AF> 

0?  C  DE  FINE  TRUE  ta-GEt  AS  3  INOE3  EN  3  E  M  T  SAMS3IAN  FUNCTIONS  UITH 
C  VA?IANCE=CJV. 

C 

SCI  >=l./COV 

;:c2»  =  o.  A 

:C3)=3, 

smssui 

$  c  s )  - :  c  i  > 

'  CS)=0. 

3C7>=0. 

scji  »=  :c  i ) 

3CP)=-C1 ) 

SCin>  =  c  . 

sci2)  =  ';ci  > 

c 

c  INITIALIZE  TARGET  INTENSITY  ASSUMING 

C  3  CIRCtJuAP  CROSS-SECTION  GAUSSIAN  TARGE'. 

C 

I MAx( 1 ) =20  * 

IMA<C2>-20. 

I MAX  C  3) =20. 

C  DEFINE  rP.UTH  MODEL  DY’NAMI  C? 

C 

UHITEC6.063) 

OGf)  FORMATC2X**  STD.  DEV  OF  T  =  UTH  MODEL  ATMOSPHEPIC  JITTeRO 
PEAOC5t&f»6E> )  3!GDT 
FORMAT! F5. 3 » 


10/ 


66C6 


OG^Afl  KAIL  74  /  7  A  P r  =  1  PMQM=  FTN  A.A+5S4 


C  IF  ICHt)  =  l  QFO  IS  ADAPT  I  VF.L  Y  r:-Tr'ATEO 
-EA0<r>,5C  l  >!CH:3 
LFdCHQ.NE.l  »GO  *  2  5  7C 

WflI!FC6t571l 

571  FOP  VATU  Xi/f  *  ADAPTIVELY  ESTIv>ArE  QFD*»//> 

5  7';  CONTINUE 
C 

CALL  TFUTHTF  Hi  ?  ,GO^OT,H,SIG3Tf  pr> 

C 

C  SET  THE  F  X  7E N  AL  MAT-.  ICES  TQ  ZFRC 

r 

P’.  55A  I  =  1  » Z 0 

H  *  1  A  (  I  )  = r.’  . 

H  1 B  (  t  )  =C  . 

H32A (I  )-C« 

H- OB (I )=C . 

HS  5 A ( I ) =0. 

H' ’H(I  >  =  0  . 

VMAXEX ( I  )=  1  • 

;:ANEMI)  =  0.' 

C')SW«I  )  =  C* 

T I  ME  X ( I  )  =0  « 

EXUTC1  *!>=-;• 

EXUTC2  •  I  )-r  . 

55  A  CONTINUE 

c 

c 

C  INITIALIZE  the  filter  ERA3R  MATRICES  T0  ZERO 

V*  C 

I)'  21  1  =  1, A 

DO  21  J= 1 ,NFf AMES 
XFMECI  »  J)=0. 

<F«E2<I,J)=  .  * 

C'lME  ( 1  ,  J  )  =0  • 

CMME?(  I*  J  >=« . 

<  F  PE  < I  ,JI=G. 

XFPt7CItJ)s'I  • 

CN^Ed  ,  J»=0  . 

21  CN® £2  (I  «  J )  =  C  • 

r 

O'  22  1  =  1  * B 

no  2  0  J=1 , MF ' A ME  ' 

PFP3  ( I ♦ J  >  =G • 

PFMSrd,  J»  =  G. 

27  CONTINUE 

C  USING  F I $  f  AVD  LC0MO  « -L  Ac  F  3  T  \’EI  SHBOA  DETERMINE  THE  CHCLE5KY 
C  5  QUA P ERGOT,  t*  ,  CF  *HE  MEASUREMENT  SOVARTAMCE  MATRIX,  P 
C 

CALL  SPTiJCVAFH,- ,8  ) 

C  r  HI  3  LOCP  MAKES  SPATIALLY  COP R ELATED/ UNCO P- EL A TFO  NCISE 

C  COMMENT  ’  THE  ft E X T  FCUR  LINES  IF  WANT  SPATIAL  CORRELATION 

C  0,-»  CA2R  1  =  1  » f> A 

C  DO  bA2.,‘  J=1  »6A 

C 

C  TFd.EQ.J)  MI,J>  =  VARM 

642*  CONTINUE 

C  MODCCMP  VERSION  OF  CHOLE SKY  PUTS  POST  BACK  INTO  CALLING  MATRIX 


IG^AM  *AI? 


74/74 


'  °  T  =  1  PMQV3 


FTN  4.R+554 


r* 


CALL  CHOLYC  *^4» 

C 

C  ^  £  AD  I*!  THE  INITIAL  DATA  FP'M  THE  EXTERNAL  T  P  AJECTCRY  T  A°E 

C 

I F  C  T  °  AGE*.  «f;E  »2  )G0  TO  55- 

55 :  CONTINUE 

REAOIOt*  >  ITF;  ,  r.XUT  (  1,1  >,EXUT  <2.1 1  tVMAXCXC  II  • 

♦COSW<ll»RA''  t  XC1 I  »  TIMEX  Cl  » 

557  FG»UArc:4t&El4.5> 

c.  EAO  CS  **>H31AC1)  »H$  ID  C 1  Kt  HS?  A  C  1  )  *HS2G  (  1  )  *  HS  3  M 1 )  • 

♦  HMRCll 

55  FORMAT CGL14. 5) 

' EAD  (  7  *  *  >XP  '  «Y3GS,?Pl)S»XVELT3,  YVELTC  »?VFLT  ;  ,TRATE 
555  FORMAT C7E14. 31 

C 

C  LOOP  UNTIL  THE  START  POINT  IS  REACHED 

C 

IFC  ’F.R*’  E.  3  TP.  UNI  GO  10  557 
xo=x?os 

TP=YP03 
YC=YPCS  . 
xnor=xvELTo 
YDOT=YVELTO 
ZDOT-ZVELTO 
HR  I  T  E  (  6 1 5  4 1  » 

r-4!  FC°MAT(T0»*  INITIAL  STARTING  CONDI  T I  ON?  *  I 
WRJ  TE(Gtw.42> 

54T  FORMAT  (T  ^  *  '  I  HE*  •  T 1 5  «  *  XPt?S  *  *  T  2?  *  *  YPOS  *  •  T  4  4,  *  ZPCS  *  • 

♦ T5  7t*TU-*  UA'E  *,T71»*H31A* « * 3 5 , * HS 2  A * » T )r * *H33A* , 

♦THZt*^0LL  A  GLE*I 
WeITr(6,343)"IMEX<l)»XCtYCt?0tT°ATE 

*  fHCI  A(l)  *HS2A(11  »HS3A(1I  *COSUCl  I 

5  4  3  FCRMATJT  1 *F5 . 3 ,3E 14 *5  I  * 

55-  CONTINUE 

C 

C 

C********************** ************************************************ 

C*»  E  ’  0  INITI  ALIZATION  ** 

. . . . . 

c 

C**  ****»**«*•****»*••***••****•**••••*••**•*«*****•»*••*•***•**»*•*»** 

O*  BEGIN  PONTE.  CARLO  SIMULATION 

. . . . . . * . . . .  4***4*****...  4. 

c 

c  MAKE  NPUfiS  ‘.'I  MULAT  It  MS  OF  MF*  AMES  EACH  FTP  MONTE-CARLO  ANALYSIS 

C 

DO  30  NS  =1  .'.FUNS 
C 

WRITtC6»544l*  3 

54»  FORMAT (/ » 1 X*  *  SIMULATION  MUMBEP*,I4I 
C 

’ I ME=0 • 

X  SH IF  T  =  U  . 

YSHIFTr  ;  . 

C  INITIALIZE  S HOOT  HCD  DATA  APPAY 
C 


DO  7  1=1*24 


74/74  r>  3  7  =  i  F*'nfo 


FT  N  4.3*5S4 


OG'AM  MAIN 


7 

C 

C 

c 

71 


c 

c 

c 

c 


lot 

c 

c 


j[* 


c 

c 


43 

c 

c 

c 

c 

c 


IK  7  J=l,24 

SUAT A  (  I  ,  J)  =  C.*'3LXC  •?.  *  .) 

INITIALIZE  'r-'U7H  M'OEL  ‘TATE  tf E CTOP 

DC  71  !  =  1 

xr< n  =g . 

XT<2  ,1) -YO 
Y  T  <  t  *  1  >  =  X  C 

ytc?»1)=yd 

I*!TIALI7C  THE  FILTERS  FAMICES  DEFINITION 
CALL  FIL  TER  <  T  DF  tVAFOF  , T  AF  ,VAPAr,DT  »PH I F*  OFD*  N3> 

ZERO  THE  FIL'EF  MATE  ICE?  F07  THE  NEXT  RUN 

Dr  IT*  T 
D‘  176  J=l, 

CFM(I*J)=C*C 
FFP(I»J>=0.r 
xfp(  n=o,o 

XFMCI )=0.0 

-ET  UP  THE  FILTER  COVARIANCE  MATT  IK  INITIAL  CONDITIONS 
PFP (  1 *1 ) =1 0  • 

PFP(?,2) =10. 

PFPC3.3) =2000 • 

^0(4,41=200 

PFPC3*5I=IC;?. 

PFPC  4  <61  —  1 0 C‘  . 

PFP<  7,7>=.2 
PFP  ( f  «:{)  =  •  2 

PF*(  1  ,1  )  =PFr  <1*1  >  * 

FFM(2.2)  =  PF(  <2  ,2  1 
PF M( 3  * 3 )  -PFr  (3.31 
FFM(4,41=PF;  (4,4) 

PFMC  ri*5>=PF0(5,~) 

PFY<j,6)sPFi?(6,t) 

FFM(  7*7)  =  pFr  (7,7) 

PFM< J,R)=PFC  <a  ,3 ) 


D  43  1=1,? 

PFPS  r( I, 1)=PFP(I ,  I  I *PFP ( I ,1  ) 
CONTINUE 


INITIAL  CONDITIONS  CN  DYNAMIC  5TATEr 


YFP< l ) =  X0 
XFPC’)=YC 
XFHC 1 1 =XFP  C 1 ) 

XFM(7)=*FP(2> 

►  ANGED=  SQFr(XC**2*YC**2*3G**'?l 
FHOB-f XT • *2*  '0**2  ) 
f ANGE  =  ( 3H0R*Y0**2) 


non  non -4  onoonnnn  on  on  on 


OGRAM  MAIN 


74/74 


CiP  T=  1  PMOMP 


FTN  4.R«-5S4 


10 


XFPC  *)  =  <-  20*  >  VEL  T0*XC  *  * VEL  T" ) / <R  HO '  ♦•030*??) 

’HOP  =3QPT CRH-'  ) 

XFPC4  >=CRH0-  »  YVSLTC-YO*  C  CXO*  *VSLT0«-Z  WVELT^  )  /RHCR  >>/(-'  A  NSE* 

«•  .oocn?) 

*■  ANGE=SQF  r  (RANGE) 

VMAX=SQP7CXVELT0**2*YVELT0**2*ZVELTC**2>/  (c  AN'GE*  •  0000  2) 

XFM(3)='<FP<3J 

*FMf  4>=*FPC4> 

XFPC5  >=S5.J 
XFPC6>=-?.0 
C 

D)  is  i=i, a 

huc  r » i  >  =■!  • 

HOC I  «  2  )  =  C  « 

15  C  ON  T  f  N UE 


HD  Cl » l ) =DT 
nOC2,2)=OT 
UTC1 ,1 )=XFPC ’) 

UT  C  2 ♦ 1 >=XFPC4) 

DEFINE  *UPPE~' -LEFT  CORNER  0C  F3V 

X  =  XFP  Cl  1-4 . 

Y-XFP  C  2 ) -4 • 

ZERO  THE  VALUES  NEr DEO  *0  ESTIMATE  QFD 
TRXXTzO. 

TPXXTO=C. 

QPRINTsG 

TRACK  TARGET  FIR  NFR  A ME  FRAMES  C  T I  ME  SLICES 


00  ;0  NR  =1 »  ’FRAMES 


A 


DEFINE  GAUSSIAN  PEAK  LOCATIONS  BASED  ON  CENTROID  POSITONt  YT 

YRAXC1)=YTC2»1) 

XYAXC1)=YTC1*1» 
iFCNUMHS.EQ.l >GO  ’0  72 
YMAX  C  1  )  =  YTC2»l)  ♦  H31BCM) 

XMAXCl >  =  YTC1 tll-HSl A  CNR > 

XMAXC2)“YTCl*l)-HS?ACX!C  ) 

XMAXC3I  =  YTC1  »1  >  -  H33AC**’) 

YMAXC21-YT  C2»l  >*HS2HCN:  ) 

YMAXC3)=YTC2*1) *HS  SBC  V ) 

CONTINUE 

GET  MEASUREMENT  NCI3E  ARRAY 

CALL  NO ISE CUtG4 I 

CALL  MULTCF»W*S4fG4,lf V) 

GET  MEASUREMENT  OAT  A 
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CALL  IOE  ALCI  ‘AX.XMAV,  YWAX,M,  .Z,X,  Y  .04  TA , D X, 0 Y ,S I G«S , ° ANG ED, R4NGE, 
►  UT  ,  Vf,A  X,  A  SF  ■■  i.  I 

CALL  I NPUT  JC  :  MAX  , 3  »  X^AX  *  24  (  X  *  Y,  DA T  A, CENX  , CEN  V  •  Y«AX • 

«■  'IGM  S, PANGED*-  AiGE*UT,VMAX  ♦A3P»0,NUMHS  ) 

ADO  CCRRELA'EO  MEASUREM-'ir  \'  p  I  3  I  TP  CENTER  *X9  PIXEL  DATA 

0  4  1=  t 

O'  4  Iff* 

DATAC  !♦*'  ,J*  >=OATAC  !♦  *  mJ*s  )*CM?HCVCa  *CI-1 1  *JI  ,0.0  I 

CONTINUE 

ADO  UNCO  PR  EL  A  ."ED  NOISE  MEASUREMENT  DATA  OUTSIDE  CEN'FR 
3  X  *  PIXEL  Af T A. 

CALL  MO  i  SEC. 'C, 5  76  I 
0^  6  1=1,24 
D~  h  J=l,24 

IFC  I.GE.3.A  0.I.LE.16.A>'0.  J.GE.R.A*D.  J.LE.1G)  GO  Tp  g 

IFC  c:  .LE.!/  1.0*?  •  C  J.LE.NZI  «CR.  (I  .GE.NZMI  .OP.  C  J. GE.NZMI  )  GO  rn  6 

DAT  AC  I, J l=DATAC I , J ) *CMPLX < UC C 2 4  * C I - 1 I ♦ J » , 0 • ) *SQRTCVARM> 

CONTINUE 

CREATE  THE  MEASUREMENT  VECTOR  F OP  THE  F ILTER  UPDATE 
< =G‘ 

d:  ioi  : =?,16 
no  ioi  j==,iG 

K  =  K>1 

ZCKI=REALCDA  ACI.JII 

IFCN' .NE.ll  CALL  C CRRELC NN ,  DA T  A,  30ATA  , XCENT ,  YCENT,X, Y* THRESH , 
♦•CCR-LI  A 

Z l C 1  I =X  CENr 
Zl C2I=YCENT 

GO  CALCULATE  T HE  ERRORS  3^  THE  LITERS  ESTIMATE  PRIOR  TO 
MEASUREMENT  INCORPQ 3 A t r ON 

CALL  STATFMCXFMEfXFME2fC‘ MSfCMMEZ, XFM,XT,YTf NRfMFRAMESf 
♦FFMfPFMSTfUT) 

IMCPRP03  ATE  MEA  SUREMENT 

IFCN0.EQ.il  GO  Tp  l£.A 
CALL  U°COKFCZl fXFPf XFMf^FP.cFMf 5FIL*UPDI 

IFCNS.NE.l  10r  10  697 
URUEC6»6961CxFPCI  1,1  =  1,31 
F0RMATC1X,*  XFP*,8F14.S) 

CONTINUE 

CALCULATE  THE  ERROR?  THE  5ILTES  AFTEP  r  HE  I NCORPO*  A  '  I OM 

OF  ; HE  HEA3UREMFNT 

CALL  3TATFPCXFPE,XFPE2»CT!0E,CX3E2tXT,VT,XFP,‘lR*NFRAMES, 
*PFP.FFR$T,UT| 


SET  THE  TIME  FOR  THE  ADAPTATION  TO  START 
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C 

IFCT  IKE.LT.- r  44 

tFCICHQ.EQ.  )CALL  QOE  S  T  <  3V  P  r  p  «  3FR  ,  U  ’  0  «  T  P  XXT  »  T  RXX  TO 

♦  »QFD  »  T I  ME . QP  ~  IJ^r.N"  ) 

44  CONTINUE 

c 

C  COMPUTE  THE  SHIFT  I  f  FO3  MA7  TON  FROM  r  HE  CENTER  OF  FOV 

XSHIFT=X-XFPC1)*4.-XFP(7> 

Y5HIFT=Y-XFP(2)*4.-XFP(-) 

C 

C  SHIFT  THE  DATA  ARRAY  APP~ 0= P I  AT EL* 

C 

C  GET  FORWARD  FFT 

C 

1*34  CALL  FOURT  (DATA. NN. 2.-1  .l.UORK) 

C 

C  FILTER  DESIRED  FREGUENCY  COMPONENTS  O'JT 

C 

IF«*. FREO.GT .12)  NFF.E0  =  1 2 
IFCEFREQ.LE.C )  GO  T0 
DO  h  I- I SF» I EF 
DO  P  J= 1 » 2 4 

DAT  AC  I* J)  =  CMPLX(0.»0.) 

R  DAI ACJ, I)=CMPLX«0.»0.) 

37 : 6  CONTINUE 
C 

C  ASSUME  IF  **“-1  THAT  THE  DATA  IS  CEM'E»FO 

IF(f.P.NE.l)  CALL  SHIFT  (DATA  .21  .XSHIFT.ySHIFT) 

CALL  SMOOTH (DAT A. SO ATA, ALPHA .2 4, N3) 

T  I  ME  -  T  I M  t  ♦  D  T 

CALL  PROPFCPHIF.QFO.FFP.PFM.XFP.XFM.VS.SVPFP.ICHD) 

X=YFH(l)-4. 

Y=XFM<2)-4.  * 

C  PROPAGATE  TRUTH  MODEL  STATE  ONE  F=A*E 

CALL  PRCPCPHI T.QOFOOT.H.VT, YI»3 .2.JT.BD. 

♦  TIFE.OT,  TRArF  •  K?  .  YO.ZO.  WAX  »  R  ANGE  *  TR  AGEN.  NR  »  NS  *EXUT  . 

♦  HS1A.H31U.HS2A.HS2B .HS3A.HS3B. VMAXEX.RANEX.TI MEX.CCSW) 

C 

IFCN3.NE.1)G0  TO  JO 
W«ITE<6»fi04»CXFMCI>,I=l,Pl 
€>~*  FORMAT  (/.IX.*  XFM  *.:>E1 4.6  > 

UR ITE(6»605)(XT<I»1). 1-1.9) 

605  FORMATUX.*  XT  *.6E14.S) 

C 

°C  CONTINUE 

(:•**.•*•*•»••••»•••»«*•••**••*••*»**»*•*•*••*••***»«**»*»*»*****»*•*•**• 

C**  END  M  0  N  T  E  C  A  »  L  P  SIMULATION  ** 

. . . . . . . . . 

C 

C  CALCULATE  MEAN  AND  VARIANCE  STATISTIC? 

C 

CALL  FIL:T(XFME.XFML2.CNME,CNNE2.XFPE.XFPE2.CNPE.CNPr2.N5UNS. 

#NFRAMES.PFPST,PFMST.XFMM3.XFMPS,xFPMS.XFPPS.CNMMS.CNMPS.CNPM  J.CNPO 
.;) 
c 

CALL  F  ILPTCPFPST.PFMST.XFPEZ .XFME2.NFRAMES.TIMPL.ACTPL. 
♦FlLPL.FILPY.ACTPY.TIMR) 
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C 

NI Ml =NFP  AMES  *2 
\>I  M=2*NFRAME5*2 
C 

! F<  I  PLOT  •  NE.  1  >  GO  TO  565 
CALL  PL<r  SCC.«n.,*l 
CALL  PLO  <3. ♦ 3. ,-3  > 

C 

C  A  1  IN  PLTB  YIELDS  X  STATISrIC>  A  2  YIELDS  Y 

C 

CALL  FLT  A ( T I MPL. ACTPL  »  FI L  °L*  NF*  AMES  «  N I v* 1 *NAME) 

CALL  PLTA<T:MPL*ACTPY»FILPYtNF^AME3,»2£M*5«NA«E> 

C 

CALL  PLT HC  TI  N1R  *XFMM 3  .  XFMP  3  ,  XF  ME! «  M I  Ml  , NF PANES  *  1  .NAME.?  »  \  l  “•'  » 
♦•PTAtFTB»PTC*u’'0) 

CALL  PLTBC  T  I  MR  .XFMMS  •  XFMPS .  XFME  .  NIM1  , NFR  AMES  .2  .N  AME *  1 3,  H  l  M , 
♦PTA.PTB.PTC.PTO) 

CALL  PL  T B  C  T  I  MR  .XFPMS  «  XFPPS  »XFPE  • \J  I  Ml  .  NFS  AMES  «  1  v NAME  *  1 7  *  M  T  *» 

♦  :  TA.PTB.PTC.PTD> 

CALL  PLTB (T I MP ,XFPM S . XFP° S  « X F PE * Nl  Ml , NFR A MES • 2 .NA ME . 21 .M I M , 
«-PTA*PTB»PTC»PrO> 

CALL  PLT‘h<TI  «R  .CNMMS  , CN MPS  .  CMME .  N  I  Ml  * NFR  AMES  *1  *N AME,  25.  *1  T  M . 

♦  c  7A.PTB.PTC.PTD) 

CALL  PLTBC  T I  MR  »C\MMS .CNMPS  *  CNME » N I  Ml  * NFRAMES  * 2 .NAME*  30  * M IM » 
♦PTA.PTB.PTC.PTD) 

CALL  PLTBITIMR.CNPHS.CNPPS.CMPi.NIMl.NFRAMES.l  ,N  AME  •  35.  N I  M  . 
♦PTA.PTB.PTC.P^Ol 

CALL  PLTB (T I  PR .CNPMS  »  CNPPS  *CNPE .MIW1.NFRAMES.2.NAME.40.NIM* 
♦■PTA.PTB.PTC.PrD) 

C 

C  CALL  SYMBOL  <0  •  .3  • .0.25.RHCA3E  >1  .0..R) 

CALL  PLOTE 

565  CONTINUE  A 

C 

URITE <6.998  7)  NRUNS. NFR A MES » V Z » XFREO .COV, V A« M .ALPH A. 

Y  SIGOT 

9967  FORtfAT<lHl,TlG.*P.LT3  =  *»I2»T33.*Ff>AHFS=*.I4»T73.«r>;UMBEP  r  ERO  PADr* 

♦  11.T10'’  »* NUMBER  FREQ  ZE  R  0*3=  •  .  1 2  , /.  T 1  0  »  *  G  AUSS I  AN  CO VAR  I ANCE=* * 

Y  F5.2.T3? .*MEASUREMFNT  NOISE  V AR l ANCE  =  * *F5. 1 « T73 . •SMOOTH  I NG  ALPHA 
ft  =  **F7.3»/.'IC» 

ft  *  TP.UTH  MOOEL  UNCE  RTAI N’- Y  =  *  .  F  7 . 3  . /// ) 

WR I T E( 6*  45  > THRE~  H 

45  FQP.HAT  ( l  v  ,*  THE  CORRELATOR  THRESHOLD  IS  **F6.2> 

GO  rC  54321 
6421  STOP 

Ef-'D 


DETAI LS 

01 AGNOS 

IS  OF  P  G8LEM 

FILTER  V 

HOLLERITH 

CONST  ANT 

.GT. 

13 

CHARACTERS  * 

EXCESS 

CHARACTERS 

INITIAL 

FILTER  V 

HOLLERITH 

CONSTANT 

•  GT. 

13 

CHARACTERS. 

EXCESS 

CHARACTERS 

initial 

ESTIMA  TE 

HOLLERITH 

CONSTANT 

.GT. 

13 

characters  * 

EXCESS 

CHARACTERS 

INITIAL 

estimate 

HOLLERITH 

CONSTANT 

.GT. 

10 

CHARACTERS. 

EXCESS 

CHARACTERS 

INITIAL 

ESTIMATE 

HOLLERITH 

CONSTANT 

.GT. 

10 

CHARACTERS. 

EXCESS 

CHARACTERS 

initial 

t_>  IP  vC  '  ri  tv  KJ  ♦  U  U  U 
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3UHP  OUT  I  NE  UFCCKFC  Zi  *XFP» X  - 3  - P*?F',»RFIL  *UPD> 

"EAL  Z1C2I  *XFPf  -  >  *XFMC-"-  >  *FFP  <3  tv>)  tPFN*n  *  •  »  **>FILC2*2» 

-EAL  TEMP  i  «  *  »  2  1  *  TEIMP2  C  2  * 2  >  *  T  EM  I N V  <  2  *  2  I • T EMP3  C2  *P  > ,  TEVP4  (  *'  *«) 
REAL  RES  I  <2>*UF3(B> 

PEAL  HT<h.2)*H(2,8|,C,ACPK<3,2> 

C 

C  THIS  SUBROUTINE  IMPLEMENTS  THE  KALMAN  FILTER  MEASUREMENT 

C  UPDATE  EQUATION. 

c  x(ti«>sx<tx-»*k<ti  mz<ti»-hkct:->> 

C  P<n*)=PCTI-l  -  K  H  PC’I~) 

C  WHERE 

G  K(TI>=  P(ri-)HT{HP(TI-)Hr»RI-I 

c 

00  5  1=1 »S 
00  5  J=1  ,2 
H(J*T 1=0. 

CONTINUE 

H(1,7>=1. 

M (2  *2 )  =  1  • 

H  C  2  *  S  >  =l‘. 

DO  6  1=1*8 

00  6  J=1  ,2 

H  r  C  I  »  J  )  =  H  (  J  »  I  ) 

CONTINUE 

CALL  MULT  (PFM»HT  »8*’J*2*TEM?l) 

CALL  MULMH.TEHPl*2.P*2.TF?1f>2> 

DO  1  1=1 » 2 
DO  1  J=1 ,2 

TEMP7II,  J)  =  -EMP2(  I,  JI«>RFIL(It  J> 

CALL  IMVERT(TEMP2,2 tTEMlNVl 

CALL  MUL  T (HT  *  T  EMI  MV *3 *2*?*TEMal )  * 

CALL  MULT CPFM, TEMPI *P  *8  *2*6AC3IO 
CALL  MUL T  CH »  PFM  »  2*9  *3  » T  FMP 3 1 
CALL  MULTCH, XFM,2,3f  l  ,REiI > 

CALL  MULT  <  GACOKi  7 EMP3 ,8  •  2  »  3  *  TE H=> 4  ) 

03  2  1=1*8 
00  2  J=1 *  3 

PFPCI  *  J)  =  PFMCI  »  J)-TEM=>3II,J) 

CONT INUE 
00  3  1=1*2 

RESI C 1 1 =Z l (I ) -FE3I I H 
CALL  MULT<GACCK,PESI*P*2,1 *UPO> 

00  4  1=1*8 

XFPC  I)=XFMCI )+UPDfI) 
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SUBROUTINE  QUEST  C  3VPFP,PFP,  J3D,nXXT,TRXXTO,QFON, 

♦  TIME*  QPR I  NT  »  NS  > 

C 

REAL  SVPFPC'5,3»tPFP<e»8ltUPO(3»H)*DXD«TC‘?*9) 

REAL  QDMAX C8> 

REAL  QFDN  C  8  »  8  )  ,QFDO Cd • 8 l « 3  AX E C 3 » 1 > 
i'EAL  NTR  X  XT  %  TRXXT  0*  QF  ACT04 
INTEGER  NFRAMES, 0PRIN7 
C 

C  THIS  routine  EST I  MATE  s  qfo  using: 

C  QD  =  C  XCTI^)-X(TI-n*CX<TI*l-X<TI-)»T«-»<H  O -PHIF*PCTI -1-0 ‘PHI  FT 
C 

C  THE  FIRST  TERM  IS  APPROXIMATED  BY 

C  € X  CT  I  ♦>-XCTI-)  )MXtTI*>-X(TI-nT  =  <Cri>RCTI>RCTI|TK<TI>T 

c  where: 

C  KCTII=  THE  KALMAN  FILTER  GAIN 

C  I  C  T 1 1  =  THE  FILTER  RESIDUAL 

C  3VPFP=  THE  LAST  TERM  IN  THE  QD  EQUA'I'N 
C 

C  A  FADING  MEMORY  TECHNIQUE  IS  USED  IN3TEA0  OF  TIME  AVERAGING 
C 

C  FROM  THE  FILTER  UPDATE  UPD=KC T I» * R C T 1 > 

C  USING  THIS  DELTA  X  *  DELTA  X  CTI  IS  OBTAINED 
C 

DO  80  1=1,8 
DO  8  0  J=  1  ,8 
QFDO  Cl , J)=C • 

80  CONTINUE 

(Jl  QDMAX  C  11=2* 

QDMAX  <  2)  =2. 

QDMAX C  3) =14. 

QDMAXC  41=14. 

QDMAX (5) =20.  A 

QDMAXC6)=20. 

QDMAXC  7>=. 5 
QDMAX  C  8) =.5 
C 
C 

NTRXXT  =0 • 

DO  10  1=1,8 
00  13  J=l,» 

DXOXT  C I » J> =UPD C I  I *UPDC J> 

10  CONTINUE 
C 

DO  20  1=1, e 

NTRXXT=  NTRXXT  ♦  DXOXT C I , I ) 

20  CONTINUE 

c 

TRXX  TO=  TRXXT 
TRXXT=.8*TRXXTO». 2 ‘NTRXXT 
C 

C  STORE  QFO  FROM  THE  PREVIOUS  ESTIMATION 
C 

DO  30  1=1, e 
DO  30  0=1,8 

QFUOCt  »J)  =  QFDN(I,*J> 

30  CONTINUE 
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C 

C  FORM  THE  NEW  ESTIMATE  OF  QFO 
C 

00  AO  1  =  1, fl 

00  AO  J=l,fl 

SAVE(I.J)-  PFMI,J>  ♦  DXDXTCI.J) 

QFONC I • Jl =  SAVE (  I »  Jl  -  SV?FP(I,J) 

AO  CONTINUE 
C 

C  INSURE  THAT  THE  NEW  QFO  IS  BOJMDED 
C 

DO  50  1=1,8 
QFACTCR=1«  ... 

IFCQFDMCItl >.GT.0.»GO  rn  51 
QF ACr09  =C  < 

QFONCr,I»=.l 
GO  TO  52 

51  CONTINUE 

IFCoQRi  CQFDMI,  I)  )  •  G'  •  QDMAX  C  I  >  )  QFAC  TOR  =QDMAX  C  t  >  /SOP  '  C 
♦QFONC I ,1  >  ) 

IFCQFACTQR.GE. I.IGO  T 0  53 
QFON  ( I*»  I  )  =QFAC  TOR  **2  *  QFDN  (  I  *  I  ) 

52  CONTINUE 

DO  5 A  J=l,3 

IF  (I .EQ. J)  GO  T0  54 

QFONC I , J»  =  QFON(I, J>*QFACTOR 

54  CONTINUE 
C 

00  55  K=l»? 

IFCI.EQ.KIGO  -0  55 

QFON (K , I ) =  OF3N(K,Il*OFACrOR 

55  CONTINUE 

50  CONTINUE  A 

C 

C  COMBINE  THE  OLD  AND  NEW  INFORMATION 
C 

DO  56  1=1,8 
OQ  56  J=l,8 

QFD.NCI  ,  J>  =  .2*QF0N(I  ,  J)«-.S»QFDT(I,J) 

56  CONTINUE 

I F  (  N  3  •  NE  •  1 )  G  0  rC  TO 
IFCQPRINT  «NE«5)G0  >0  70 
C 

QPRINTrO 
WRITEC6,6l >' IMF 

61  F ORMAT  C 1 X  » // , *  AT  T I ME  =  * , F 1 0 . A > 

WRI  TEC6*62M  COFDN(I*J>  ,  J  =  1  ,3  >  ,r  =1  *3  > 

62  FORHATCIX,/, *  ESTIMATED  QFD  I S * • / , C I  X  ,FE l A. 5 >1 
WHITE(6,63)TRXXT 

63  FORMAT (IX,/,*  TRXXT  =  *,EIA.5) 

C 

70  CONTINUE 

QPRI NT=QPR IN  *1 
PETUFN 

e-;d 
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8UBR  CUT  I  NC  S  r  ATFM(  XFME »  V  F«E  2  ,  C  M*E  *  CN  HE  2  ,  XF*  ,  XT  ,  YT  ,NR  •  NFR  A  ME?  ♦ 
*-PFHfPFMST  rUT  ) 

INTEGER  NT  NFRAME ' 

REAL  XFMEC4ti«F?AMES>  ,XFME2<  4  *  NrR  AMES  )  *CNME  (4  *  NFR  AMEC  ) 

REAL  CNME2<4,nFRA*e:I 
RFAL  XFM<8>,XTCR ,l),YTI2.T > 

REAL  PFM$T(P ,200 ) ,PFM<3,F) 

REAL  UTC  2  » 1 ) 

THIS  ROUTINE  GATHERS  THE  INFORMATION  THAT  WILL  BE 

Pf.  GUIPKO  TO  COMPUTE  THE  STATISTICS  OF  THE  PREDICTION? 

OF  THE  FILTER  PRIOR  TO  MEASUREMENT  INCORPORATION 

FIRST  COLLECT  THE  ERROR  IN  THE  PREDICTED  DYNAMIC  LOCATION 

XF  ME  (  1  »  N  R  )  =  X  F  ME  C  1  ,  NJ;  )  ♦XFM  C  l ) -X  T  (  1  *  l  > 

XFME ( 2  »NR  )  =  VFMEC2»NE>+XFM(2)-<TC2*1> 

XF  ME ( 3  »NR ) =XFME<  3  »  NR ) ♦XFM  <  3 ) -U  r  1 1 » 1  ) 

XFMFC4 )  =  XFME( 4,NR 1 ♦XFMC4) -JTC2  *1  ) 

NOW  COLLECT  THE  SQUARE  CF  THAT  ERRO- 

XFME2  41 *NR)=XFME2< 1 ,NR  > ♦ < XF M<1 ) -XT« 1 , 1 ) ) 

XFNE2<2*NR>  =  XFME2(2,MR>MXFM<2)-XT<2,1 >  >**2 
XFME2C3.NR ) - XFME2 ( 3 ,NR ) ♦ C XF X C 3 ) - JT C l *i > ) * *2 
XFME2  <  4  *  NR  )  -  XF  ME  C  4  »  NP.  )  ♦  <  XFM  C  4  )  -'J  T  C  2  » 1  )  >**2 

COLLECT  ERROR  IN  CENTP.OID  PREDICTED  LOCATION  MINUS 

CNME  <  1  *P.P  l  =  CNMECl*NP)«-<XFM<l>»XFM(7)-YTCl*l)  ) 

CNME  (2  *NR  )=Ci\ME C 2 *NS  > ♦<  XFM  (  2  >  +XFM  CS  > -Y T  C 2  *1 >  > 

CfJME(3,NI  )=CNMEC3»NR  )+XFM(3)-<Tf  3,1) 

CNME(4,N- )-CNME<4,NR)+XFMC4)-XT(4,l)  * 

COLLECT  THE  SQUARE  OF  THE  ERROR 

C  N  ?1E  2  (  1 »  L  R  )  =  C  N  ME  2  C  1  *  NR  )  ♦  t  X  F  M  {  1  )*XFM  t  7  >  -Y  T  ( 1 , 1  )  >  *  *2 
CNME2  (  2 ,  NF  )  =  CNME  2  <2  ,  \c  )  (  XFM  (  2  )  ♦XFM (3  )  -  TT  (2  *  1  )  )  •*? 

D'  10  1  =  1,3 

PFMST<I,NM=  PFMST<:,NR)  ♦  :>FMC[,I> 

CONTINUE 

RETURN 

ED 


4 


4 
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SUBROUTINE  :iTATFPCXF°EtKFP£?  »  C  RPE  *  CNPE2*  X  T  *  T  T  ,  XFP  ,N»  tNF°  AMESt 

«■  pfp  *  pfps  r  *ur ) 

INTEGEP  riR,*4FcA,'t:n 

PEAL  XFaE(A»\F&AMES)«XFPE2(A«'}F3AMES)  *  CN  P  E  (  A  »  NF  R  A  ME  S  ) 

SEAL  CT4PE2<A  , FRAMES) 

REAL  UT( 2 « 1  ) 

REAL  XTC.i.l)  ,YTC2  tl  ).XFPC4) 
r-'  E  AL  PFPST  C*  «?C2)tPFPCS*R) 

THIS  ROUTINE  GATHERS  THE  T'l FORMATION  THAT  WILL  BE 

REQUIRED  TO  COMPUTE  HE  SMTIS^TCS  CM  THE  FILTERS 
UPDATED  STATE  ESTIVATES 

COMPUTE  DIFFERENCES  THAT  HILL  BE  NEEDED 

DIFl=XFPCl)-XTCltl) 

OIF?=XFP  C2)-XT  <2*1  ) 

0IF3=XFP(1 )*XFP(7)-YT (1  » 1 ) 

DIFA=XFP  C2)*XFP<5 )-YTC2  »1) 

DIF5=XFPC3)-UTC1,1) 

0IF6=XFP(A)-UT<2,1  ) 


FIRST  COLLECT  THE  ERROR  IN  THE  DYNAMIC  LOCATION  ESTIMATES 

XFPE<1 tNP)=XFPECl»NR)*DIFl 
XFPE<2,NF.  )=XFPE(2tNr-  )+DIF2 
XFPE  (  3  »NP  )  =  XFPE(3,r.'F  >*OIF5 
KFPECA  ,Nr-  )  =  XFPE(A,ND>OIFS 

NOW  COLLECT  THE  SQUARE  CF  THAT  ERRO- 

XFPE2C1  t*lP.)  =  XFPE2C  1  *N-  )>OIFl«*2  * 

XFPE2(2tNR)=XFPE2C2«Np )«-DIF2**2 
XFPE2<3»NP)  =  <FPE2<3»N.R>*DIF5**2 
XFPE? <  A? NR  )  =  XFPE2  <  A  *flR  )  *01 FS  **2 

NOW  COLLECT  THE  ERROR  TM  THE  CENTROID  UPDATE 

CMPECI  tNR  )=C’.PE<  t  *W*--  )*DIF3 
CM PE (2  *Np )=CNPE(2» NR )+OIFA 

NOW  COLLECT  THE  ERROR  SQJARE3 

CNPE2 (  1  •  NR )  =CNPE2  <  1  »'JK  >«-DIF3*»2 
CNPE2(2»NP )=CNPE2C2*SR)*OIFA**2 
u -  io  i  =  t»e 

PFPST  <  I  »  NF  )  =  PFPST  <  I  »NR  I  ♦  °E=>Cr.I) 

CONTINUE 

RETURN 

END 
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.SUBROUTINE  FIL  ST  CXFME.XFME?  , CN ME , C V ME2 , XFPE » XFPE2 ,CNPE » C NRE2  * 
.1  ‘.'RUNS  t  NF  3  AME  3  *  PFPST  » PFM'  T  ,  XF  3  ,  XF  MPS  >  XF  PMS,  XFPPS  tCNMMS  *  CMMP  ' 
♦  CNPMStCNPP  > 

REAL  T  I  ME  (20  0  I 
HEAL  riMEMCTCO) 

INTEGER  f.'RUNo  •  NFR AME3 

PEAL  XFME  C4,  NFR  AMES  ),XFKE2C  4,  FRAMES)  »CNM£  (4  *  NFp  AME?  ) 
r  EAL  CNME2(4fM FRAME  ) 

REAL  XFPEC4t‘ FRAMES ),XFPE2( 4 *NFR AMES ) »CNPE  C4  »  NFR  AME > ) 

PEAL  CNPF2C4 ,NFRAME ') 

REAL  XFMMSC4  *200 ) * XFMP S C 4 , 2 0 0 ) * XFP MS C  4  * 20  0 > 

REAL  XFPPS<4 ,200 ) 

REAL  Cr:MPS(4*2C31*CNMM;C4*230)*CNPM'  (4,200) 

REAL  CNPt-'S(4  ,200  ) 

REAL  PFP S  T ( '  *NFR AMES  )  »PFMST  C  3  tNFRAME  '  ) 

EXPLANATION  OF  DATA  STRUCTURES 

XFME  IS  THE  XPOS  OF  THE  -ILTET  AT  MINUS  TIME  ERROR 
THESE  ARE  ALL  COMPATIBLE  WITH  THE  AR'tVE  ROUTINES 
XFMMS  IS  THE  XPOS  MEAN  ERF3R  AT  MINUS  TIME  "INU3  ^  I  CM  A 
XFMP3.  IS  THE  XPOS  MEAN  ERRCC  AT  PLUS  TI^E  PLUS  -ISMA 
ALL  .NAMES  FOLLOW  THIS  CODE 


THIS  ROUTINE  COMPUTES  THE  STATISTICS  ON  THE  FILTER  ERRORS 


m  1  1=1,4 

do  i  j=i,nf’Ame: 

XFME  (I  ,J)=XF'»-Er.  ,J)/FLCAT  CNR  UN’S) 

XFPECI , J)=XFPECI , J) /FLO  AT  CNR  UN S) 

C.NME  C  I ,  J  )  =C  .  ME  C I  ,  J)  /FLOAT  C  N’  U  VS  ) 

CNPEC:,J)=Cf:PEC!  , J)/FLOATCMRl'N3) 

DIV=FLQAT  C.NP!,NS-l  )  * 

XFMEMI,  J)='QRTCCAHSCXFMF2CI  ,  J  )-FL  CA  T  OP  UNS  )  *  C  XFMEC I  ,J)  *  *  2  )  >  )/DIV) 
CFf’E.ICI,  J)  =  SORTC  CABSCXFPE2CI  * Jl-FLOA TCNRUNS)  *CXFPECT»J)*  -»?))  )/OIVI 
C .ME  ->(lt  J)=SORTC  CA8SCC'NME2CI,  JI-FL9A  T  C  MRUNS  >  *  CCNME  C  I  ,J)**2)>  )  /DIV» 
CNPC2CI,  J)=SQRTCC  AHSCCNPE2C  I  ,J> -FLOAT C  NPIJNS  )  *CCNPECT  ,J)**2)  )  )  /OIV> 
Dr  1301  1=1,4 
DO  1001  J  =  1  ,r.FRAME: 

XFMMiCI, J)=XFMECI , J)-XFME2CI,J) 

XFMP  SCI,  J)  =  vFMECt  ,J)*XF**E2  C  I  ,  J) 

XFPK.ICI*  J)  =XFPECI  ,  J  )-X  FPE2  C  I  ,  J  ) 

XFPPSCI, J)=XFPECI , J)*XFPE2C! , J) 

CNMM7CI, J)=C  MEC I , JI-CNME2C I , J) 

CTiMPICI,  J)=CNMECI  *  J)*CNME2C  I  ,  J) 

CMPM  I C I , J ) =C\°EC I ,J)-CN=E2CI ,J) 

CfiPP  I  Cl,  J)=C\PECI  ,  J  )«’CN^E2Cl  *  J) 

no  12  1=1,8 

DC  12  J= 1 ,NF  *  AME  7 

PFPST  CI,J)=SQRTC  PFDS  '  C  I  ,  J  ) /F  >m  0  A  T  C  rjau'JS  > ) 
PFMSTCI,J)=SQRTCPFMS'CI ,J)/FL0ATCNPUN5) ) 

CONTINUE 
WRITE  CO, 2 ) 

FORMAT  CT2,*FPAME* ,T1C ,*XERR  C -)*,T2  2,*SXERPC-)*,T34,*YERRC-)*, 

It  T4G,*3YEPHC-)*  ,T58,*XVELERRC-)*,T73  »  •SXVELER°C-)*,T82 
If  ,*YVELERF  C-t*  ,  T34  ,  *SYVELERf>  C  -  )  *  ) 


[%] 


•  U  T  I  ?:£  FILS  7 
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T1 MXX=0. 

0.?  3  1  =  1  .NF  ■  4>'FS 

VRirE*G,4)  1  IMXX.XF^F*!,:)  »xFME:2(l.I).XF*E*2fI 
t  1  .XFME2<2  » I» • X FPE ( 3 *  1 1 , X FME ? *  3 . I > ♦ XFUE * 4 , I > , XFME2  *4 , T > 

4  FORMAT  <  T  1  *F>,  •  3  E 1 2 •  j  1 
timxx=timxx*-*i./30.> 

3  continue 

r  I  M  Y  Y  =  0  • 

wr  i  r  f  ( <b ,  n  > 

5  FORMAT  <T2**FL  AME*  .TIP  ,*yEPRC  ♦)  *  »T22.  *$XE?»  t*  I*  tT34t*YER4  CO*. 

*  r46,  *  SY!ER<*>*  ,T5*. *XVELERR  *  ♦  1  *  •  T70  ♦  ‘SXVELERR  *♦>.  , 
fi  r  E  2  »  *  Y  WE L ERE *  ♦ )  * »T94**SYVELEPR(*I*I 

DO  £-  1  =  1  »  NFR  AMES 

UnITEC£.7 I  r: HYY*XFPF<1 .1) »XF3i2Cl ,r ) tXFPFC2. n 1XFPE2C2* I 1 
* *XFFE  C3t I)*XFPE2*3*I>*XFP£(4*I).  XF°E2  C  4  »  T  I 
7  FORMAT*'  l«F9.3»BE12.5> 

TIMYY=TIMYY*ll./30.1 

6  CONTINUE 
TIRXX=". 

URITFC&tlOl » 

101  FORMAT* T2 ,*Fr AME* .T12»*Cf E2 < -  1  * • T 30 » * SCMER *- > * ,T55 . * YCER *-)*♦ 
A  T 63  f  *SYCER <->*) 

DO  132  1=1  ,NFR AMES 

WRITE*  6*  10  3)  TIMXX.CfiME*  1  .  1 1 » CNME2 C 1 .  I  )  *  CNME  *2*1  1  *CNME2<2  .71 
10  3  FORMAT  (T1  »F3.3»T  10.E12.5.T23  »  E 1 2. 5 1  T  5  2  ,E  1 2.5  .  T6£  .  E12 .5  ) 

T I MXX=T IvXX**l./30.  I 

102  CONTINUE 

r i mx  x=o • 

WRirr*6,ici 

10  FORMAT  <T2  . *F  •>  AME  *  »  T  1 2  »  *C'IEP  <  ♦  1  *  *  T  33  •  *SCNER <♦ 1  * .T55 * *Y CER  (♦>*. 
i»t63,*SYCEp<«-)*  » 

0?)  2  l  =  l  tNFRAME* 

WRITE  <6, 9)  TIMXX*CNPEC1  .11  »C.\,aI2Cl  ,1  1 »  CVPE 12 . 1 1  »CfcjDE2  *?  *  T  1 

7  FOR  MAT*  T 1 .F"  .3.T10.E12.5.T23,  El  2.5.  T52.E  12.5  .T66.E12.5) 
TI.MXX=TIMXXMi./30.) 

-  CONTINUE 

TIMXVrQ. 

WRITE<6»  17) 

17  F  0  R  M  A  T  <  /  /  »  T  2  .  *F  p  A  ME  *  *  T 1 4  *  *  S  Q  P  T  »F=>  <  1  » 1  )  *  *  T30  .  *SQP  T  PFP*2.21*. 

*  Tr;  3  »  *SQP  PFP*3»3)*fT6.n»3!),r  3F°(4,4>*> 

DO  13  J=  1  *NF!-  AME  ' 

WRl  TE<*b»l  4)  I  IMXX.PFPS7  <1  »  U I  »:,FFST*2»J>  *PFc3tC3»J)  .PFPST  *4.  J) 

14  FORMAT <T i.F  ,3  *T  l  2» L 12 .5 » T 2 ?  » E l 2 . 5 . T5 2 »E l 2.5 . T66 *E 12 . 5) 
7!KXX=TIMXXMl./30.» 

13  CONTINUE 

WRT  TE<6. I2  1 

1?  F0RMAT*7/tT2f*FPAME.,Tl4»*S3Rr  PFM* 1 , I )*, T30 ,* SORT  PFM12.21*. 

*  T5  3  .  *  3QP  "  FFM*3»3)*»T6'.i»*SQ4’  3FM*4,4>*> 

TIMXX  =  :.. 

DO  15  1= l .NFRAMET 

WRITE<6»l£>r!MXX*PFM3TCl.I)tPFM3TC2fII.PFM^T<3.n*PFMSrC4,l) 

15  FORMAT*!] .F ' .3.T10.E12.5, T2) tri2.5»T52»El2.5»T66tE12.5) 

_  TIMXX  =  TIMXXMl./30.) 

If  CO NT  T NUF 

C 

1 5T  A3  7  =1  5 
I F  I  *«  =  G  0 
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'JFINE  FrL? 
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0°T=1  PPDM  = 


FTN 


m 


T4 


C 

C 

C 

C 

c 


ra 


'  o  ac  7 

HJ  K=l,2 


00 

D  ■-  - 

T I  MXX=FL0 AT  (  I  STAR'  >*U./70» 
TIKMH=FLOAt  c  :fin>  *(  1./30  .» 

WRITER*  >  A  )  T I  MXX  *  T I MMM 
FOR  M  AT  (//  » 1 X  *  *  FP.OH 
NR  I TF (6  i  >5) 

FCRMATC/ ,T4,  *  X/Y  EPRM*»rl?** 

♦•14^.,*  X/Y  CF'-RP*  »Tf  c  •  *  X/Y 

SCFP  R  M  *  *  T 1 C  2  *  A  X/Y  SCFRRP* > 


'IVF**F?«5**  rp  " I ME  *  »FT  •  3  > 

X/Y  ERRP*tT32.*  X/Y  CERRM*. 
3ERRM**T74,*  X/Y  3ERRP*  » 


<0* 


X/Y 


'HE  KCLLrWIr:G  CALCULATIONS  ARE  USED  TO  FIND  'HE 

AVERAGE  L R R 0 • 3  OVER  A  GIVEN  PE 5  I OD 

GET  I S  T  A  R  r  AMO  E F I FOR  THE  DESIRED  RANGE 


1 

D~  >}  I  I  =  lt2 

E.R  -  M=0  . 

. 

CFa*  f<= 3. 

'  • 

CEP-'  P=G  • 

SEP P=0. 

** 

* 

3  ERR  M  =  Q.‘ 

3CE5H=0. 

* 

3CE-P=3. 

r-3 

r,l 


*0 
H  .2  7 

C 

C 

c 

c 

c 


DO  F2  J= 1ST  A? : *1  FIN 
ER‘-'M=EPRH«-XFKECI*J> 

ER '•‘P=EP HP  ♦  XFPE  C  I  »  J) 

CEORv-1=CER  M-CNHECI  t  J» 

CEr!RP  =  CERR P*CMPEC  I»J1 
SEPRM=3ERRM»XFME2  (  I  *  J) 

SEC.RP=  JEFF P*XFPE2<  I  »  Jl 

3CLRM=C'ME?CI« JI+SCE  M  * 

3CEPP=  TCEl-  P+CNPE2  (  I  *  J) 

CONTINUE 

EPR  v  =  EFMy/FL  jAT(  I  FI N- 1  ST ARr  ♦•II 
FRRP-EH^P/FLT A T ( I  FI N-I STAR T  *1  » 

CERHN’  =  CFPPM/FLCAT(IFIN-ISTA’  r«-i> 

CEHHP  =  Ct ..  M  P/FLO  A  T<  IF  IN- 1  3  TAR  r«-l  ) 

3EPPM=3E  H/FLCAT  C  IF  I  fi- 1  3T  AR  r  ♦  l  > 

OEPR P=  3E ,J P P/FLCA T  <  I F I  N-I  3T A  R  1  ♦  l  > 

3CER  w  =  SCER  M/FLOA  T  (  IF  IN- 1  STAR”  L  I 
:CERP  =  SCLRP/FLCATC I F IN-I 3  TAR r ♦! > 

NRITE  CS*  >3)FRP  P»ERRP*CERP?**CERR<»»3ERRH.  3ER«  P  »  SCER  M*  SCE?  P 
FORMAT CLX »< RE  1 4.0)) 

CONTINUE  . 

•.FCNFRAMFS.GI.  14r  I I  START =13 5 
TFCNFRAMES.G’ -1A i) IFIN-153 
CONTINUE 
CONT INUE 
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'ebitv 


FILST  74/74  0PT=1  PMflMP 


FTN  4.P4.564 


C 


110 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

icr : 


DC  110  r=l»*.  FRAMES 

T I  ME N  IS  T  Hi:  7 1  vr  MINUS  ARMY  SET  FCR  MULTIPLE  PLOTS 
TIMEMC  I)  =FL'.  AT  (I  >-.2 

IF C I •  FQ  .1  )  T  I  M  E  M(  I  >  =  1. 

TIME<I)=FLCAf<I  ) 

T  F  C I .EQ. 1 >  1  IME( I  >  =  1. 00 1 

NOTE  THE  ORDER  OF  OUTPUT  TO  TAPE 


ME  AM 
Ml  AM 
ME  A* 
MEAN 
MEAN 
MEAN 
MEAN 
MEA»i 
MEAN 
MEAN 
MEAN 
MEAN 


ep  °,  ;i 

EKrtGK 
ES  5L 

EKMOc. 

E.IROP 
EPF.  Of 
LflRO9 
CPF  C 
ERROR 
FPRG 
E7P0C 
ERRnn 


AT  MINUS 
AT  MINUS 
AT  MINUi 
MINUS 
MINUS 
MINUS 
MI  NUS 
MINUS 


AT 

AT 

AT 

AT 

R  AT 


AT  MI  .NUS 
A^  MINUS 
AT  MINUS 
AT  MINUS 


X  POS 
X  POS 
i  X  POS 

Y  PCS 

Y  PQS 

Y  POS 
X  CEN 

X  CEN 
X  CEN 
r  CEN 

Y  CEN 

Y  CEN 


FOLLOWED  BY  PLUS  X  POS 
MINUS  SIGMA  FOLLOWED  BY  X  POS 
3LUS  SIGMA  FOLLOWED  DY  PLUS  XPOS 
FOLLOW F. D  BY  PLUS  Y  POS 
MINUS  SIGMA  FOLLOWED  BY  PLUS  Y  °OS 
PLUS  SIGMA  FOLLOWED  BY  PLUS  Y  °OS 
30S  FOLLOWED  BY  PLUS  XCEN 
POS  Mp;uS  SIGMA  FOLLOWED  BY  PLUS  X 
POS  DLUS  SIGMA  FOLLOWED  BY  PLUS  X 
PCS  FOLLOWED  BY  PLUS  Y  CEN 
POS  MINUS  SIGMA  FOLLOWED  BY  PLUS  Y 
POS  PLUS  SIGMA  FOLLOWED  BY  »LUS  V 


WRITTEN  WITH  A  6E12.S  RECORDS  WHICH  IMPLIES  EACH  PLOT r  ABLE 

SET  OF  POINTS  CONSIST  OF  14  SECONDS  WITH  THE  LAST  RECOPD 
CULT  CONTAINING  2  POINTS  I  NS “ EAD  OF  6 


VHITt<l*100r  )  (<TIMFMCI)  .XFMECl  , l ), T l ME C I >. X FPE C 1  ,I)>,!=1,20» 

W9 I  TEC  1,1001 )  CCTIMEMC I ) , XFMMS C l , I > • T I  ME C I » , VFPMS < 1 , I ) ) , ' =1  ,20  » 
AR  I  TEC  1,100';  I  (<  TIMEMCII,  XFMpSCltI)»TIME(I),  XFPPS  (1,1)),  1=1,20) 
UR  I  TEC  1,100  )  CCTIMEMC 1 1 ,XFMr C 2 , I ) , T I  ME C I » , XFPE C2 , 1 > > ,T = l  ,20 1 
WRIT  EC  1,1 00  )  CCrIMEMC I > , XFM«SC 2 , 1 1 , ~ I  ME C 1 1 , XFPMS C2 , I )> , 1=1, 20) 
WP I  TEC  1,100  >  CCTIMEMC  r»,XPNPSC?,I>, TIMEC I ) ,XFPPSC2, I )),I  =  1,2  0) 
WRIT  EC1, 10Q.V  )  CCT  IMEMCI  >,CNMEC1,I  I.TIMEC  I  >,CNPEC  »,I>  )  »I  =1 ,20  I 
WFITFClflCO  >  CCrIMrMCI»,CNMMSCl,II,TIMECI),CNPM?Cl,n>,T  =  l,POI 
WPITEC1*  100  )  CC  riMEMCDtCNM^SCl  ,1  ),TIMECI  )  ,  CUPPS  C 1  *  I  )  )  ,  T  =  1 , 2  0  ) 

wp  i  rr  c l *  i o oc  >  c  c  r  i mem c  i  >  ,cn me c  2 , £  > , t  1  me c  1  >  ,cnpe c ? ♦  1  >  > , :  =  1 , 20 > 

WR I  TEC  1*100  >  CC  IMEMC I ) ,CNMMS  C  2  *  I > ,T IMEC I ), CNP MS C2, 1)1,1  =  1,20  ) 
WRIT  EC  1,1 00 ' )  CC .  IMEMCI),CNMPSC2,I),TIMECI),CNPPSC2,I)>,'=1,20> 
F0PMATC6F12.-) 

°ETUF N 
F  D 


DETAILS  DIAGNOSIS  OF  P  CBLEM 


7 HEP  f  II  NO  PATH  TC  TH!S  STATEMENT 


OU r : f  E  F*L P" 


74/ T4  C?7=l  PVQMP 


FT M  4.a«^64 


C 

C 

C 

C 


C 

C 


2  0 
C 

c 


20 

c 


40 


41 

30 

C 

c 


50 

c 


SUB- OUT  P  E  rrtPMPFF  r.PFM£^.<FPE2»KFME:‘.MF4AMES.TIMPLtAC'“L 
*y  ILPL»F:LPY,ACr»Y.Hna> 

•>FAL  TlMPL(400)fFILPL<4  00)  » AC* »L C 4 00  >  ,FILPV(  4  00  )  ,  ACTPYC  40  0  > 
•F.AL  PFPOTC  .NFS  AMES)  »PFMST{  ?  «  VFPAME  ‘  ) 

,J  E  A  L  XFME2C*  *MF4  AMES)  »  XFPE  2  C  4  *  NFPAME  » 

PEAL  TIP*  (20  ) » 


7 HI  3  SUB' OUT  T ML  COMBINES  DFP  A\JD  PF«  « AND  XFME2 
AND  YFPL2  F <' ~  “LOTTING  PURPOSE: 

k:un'=i 
KOUM • 1=1 
KCU\'  ■  2  =  3 
KOUN  7  3=1 
KCU't  T4=l 
rlM=n. 


DC  1C  1=1 ,NF- AME 

FI LPl C KCUNT ) =  CPFM3T  (1*1)) 

FILPLCKOUMT  ♦  1  ) '=(  PFP3  M  1  •  1 1  ) 

K  0  UN  T  =  Kl>  U  T  *  2 

CONTINUE 


DC  20  1=  1 » •  iF0  ANE 3 
ACTPL<K0UNT1)  =  XFME2<1 »I  ) 

AC7PH  KOUNT  l  *1  )  =  XFPC2  ( 1  tl> 

KCUN’lsKOUH' 1*2 
CONTINUE 

no  3C  1=1 »NFr  APE ' 

IFC.LT.l.SMiO  ro  40  * 

•'I  MPLCK0Ur.T2)  =  TIM 

:IVPL(KOUNT2*1>=timplCKCUMT2)  .000001 

T  I  MP  1 1 )  = '  IM 

KOU'iT2=KCUN  2*2 

TIM=  IM*f 1./30.I 

tiC  TO  41 

’  I  MP  L  <  I  )  =  !J  • 

r  nr  (i>  =  :  • 

' I HPLC2> =.OCuC01 
T I M= " I M  ♦  1./5C. 

CONTINUE 

CONTINUE 


03  5 n  I=l*NF‘AME.' 

Ft  LP  YC  KOU’i  T  3  >  =PFME  ‘  <2tI» 

F  I  LPY  C  KCUr.  T 3 >1  >  =  PFPSM?»I  » 
KOUNT3  =  KCU? T3*2 
CONTINUE 

no  5?  1=1 »NF TAMES 

ACTPY<KCUfrT4)=XFME2(2 ,1  » 
AC’PYCK;'U‘  T4»l  »  =  XFFE.?C?*I  » 
K'.*  UNT4  =K0U  \  T4  ♦  2 


ft 


'UriJE  Fl.Pf 


74/74  rpr=l  FMPw:> 


GO 


f  •' 

C 

C 


» 


h 


i  0? 


CJfjrrNUE 


r-  ETU-N 
fj;o 
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UT I  ‘  E  Tr  jrH 


1%/  7  4 


CPT  =  1  Pf'QM3 


FT»!  4.*«-5S4 


I 


C 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


lUHr  out  :\t  ;  =  u r h c p h i  r . g d  •  m » >< .  s r  go r ,  o ' ) 

»’  AL  PH.t“  <'■*•■>>  .OOC-t*,  » 

REAL  GO  <6,-1 


rHF.  0  T  A  T  f  SPACE  M  ’DEL  I  : 

l)<XDl/Or-F7  *  XO+HU+GT*UT  amd  YO=H»YO 

WHFfcE 


c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 


A  .0  H  '  * 


:  i  o  i 
:  o  l  o 


l  j  o  o  o  : 

3  o  i  i  o  :  * 


xn= 


:  xt  : 

:  yt  : 

:  x  l  a  : 

:  x  2  a  : 

:  x  3  a  : 

:  yia  : 

:  Y2  a  : 

:  Y3A  : 


THE  SOLUTION  OF  “HE  OY'IAMIC  EQUATIONS  IS 


XO<r*l>=  PH!T*XO<I»  ♦  SQRMGDMWT 

WHEPE  UH IT  =  5T  ATE  TRANSITION  «ATPIX 

lIGOTs  ATMOS  NOISE  STANDARD  DEVIATION 
HT=  G AUSSI  AN  NOISE  VECTOR 
<30=  COVARIANCE  MATRIX 
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ESTATES” 


f>  n 


’UTPI  THJTH 


7  4//4 


'F  T  =  1  P»OMP 


FTH  *.**■5$* 


10 


K=.362ic  c, ox 

TD=1. 

A=14.14 
B=6  39.5 

DO  1  1  =  1  ,* C 7A  IE 
DO  1  J=1 ,NC~A'E 
FH !r<I ,  J  )  =  , 

1  OD«:,J)='l. 

°hi  '<i*i  >=i:vp<-ur/  n> 

PHI*  (2*2)=EXP(-DT/'D) 
cHlr(l»l)=l. 

PHI T  <2 ,2  >=FHI ;  <1  ,1  ) 

PHI  7 (3»3)=Eyp<-A*D  ) 

PHI T<4*5 )=OT*EXP(-G*DTl 
PHTT<5,‘3)=EXP<-B*D  ) 

PHI T<6*fi)=EXP<-A*0T ) 

PHI  1(7,7  >=LXP(-B*OT) 

PHI  ’  <7*. :  >=Uf*E.vp<-n*OT) 

PHl'Li.C  >=F.XP(-H*D"  > 

FACT  =  C K**2 ) * (A* *2  )  * (B* *4 » 

F  AC~ 1 =A-B 
FACT  2  =  A*B 
FACr3=2.*H 
Gl=FACT/(FACri**4» 

G2=FACT /<FACri**3) 

G3=FACT  t <FAC71**2 ) 

Pl=l.-tXP<-i.*A*Dr ) 

P2=1*-EXP(-FACT2*D~) 

P3=l*-CXP(-<7,»n*OTI 
P4=nr*CXP<-FACT2*D‘ I 
P5=OT*E  XP(-2.«H*OT ) 

Q  D  ( 1 ,1I=C* 

QO (2*2) =  00  ( 1*11  A 

Q0(3,3I=<G1 *D1)/(2«*A) 

OD<  5*4) =P2* (G2/FAC7  2**2-Gl/FAC"2 )-P4*G2/FACT2 
QO(3,b)7:G2*P2/FACTp 
OD<  4,3I=QD( 3,4| 

QD(4*4)=::,3*(Gl/rAC  13-2  .  »G2  ff  AC  T  3  *  *  2  *2  .  *  G  3/FACT?  *  *3  >- 
*»  Pb*<-G2/B«-G3*Dr/FACT3«’2.*G3/FAC73**2> 

70(4,5>=P3*  <G3/FACT3**2-G2/FACr3>-P5*G3/FACT3 
Q0<5* 3>=OD( 3,5) 

QD<~  ,4>=0D<4,5> 

QO (5  *5  >  =P3  »G3/FACT3 
DO  2  1  =  3*5 
00  2  J=  3 ,5 
QD<  I  *3  «  J+3 ) =Q0< I «  J) 

?  CONTINUE 

DC  -64  1  =  1*6. 

DO  6  4  ,1=1*  C 

.  c64  QDF <  I  *  J)  =f)D<  I  »2  »J+2  ) 

CALL  CHOL v  COUP  *6 ) 

DC  -65  1=1*6 
O'  -65  0=1*6 

°65  QD<  t*2»J*21=QDc  (ItJ) 

00  3  1=1*6 
DC  V  J=1,F 

5  QO-OOfC  I,U)  =  f)0<I  ,  J> 
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10 


« 

Ht 

I.  A 

1®  9* 

* 

'-9 

’•  • 

fy..  - 

4 


2UBR  )UTI  r.C  F  P  •"*  P  {  PHI  T  iQOROOr  iH»  XT  *  Y  T  *  N  ,v-,UTtRO* 

♦  TIME  ,0T»  TRAThtXD  tYO.ZCtVMAX  *R A XSE • TR AGEN* NP » NStEXUT * 
♦HS1A,HS1H»HJ?A ,H32Bf HS3A.HS3B, VM  AXE*  »  R  A'!EX  .  T TMEX*CC5V> 

REAL  PHITCN*N>  tQORCCTCVfVI »XTC V*i) ,YTCM,1 >fHfM,N) 

REAL  TEMPI (" « 1>*TEMP2<  5 .1 >  »TE*P3CI .11 
3  E  AL  U  T  (  2  » 1  )  »BD(E  »2> 

INTEGER  TftAGEfi  *NJ 

kEAL  EXUT<2t  >PO),HSlA(?UO>  ,HS13<203  )*HS2AC2C0  >  •H'T2B<203  I 
“EAL  H  3  3  A  (  2  (>  U  >  »H 1301200  I  «  V  *  A  XE  X  C  2  0  3  >  t  R  AMEX  (2  C  0  > 

;  EAL  TIMCXC2:0>»COSW(2TC> 

C 

c 

C  THIS  RCUT  I'iF  IMPLEMENTS  T  HE  STATE  TRANSITION  EQUATION. 

C 

C  XT  C  I  ♦;  )=PHIT*XT(I  )  ♦  Qa,>C0T*WB 

C 

C  WHE-E  xr=  STATE  VECT0R  CNX1) 

C  PH ! T  =  STATE  TRANSITION  WA  T  E  I  X  CNXN  ) 

C  GOMJCTr  S r  A  TE  UNCERTAINTY  COVARIANCE  MATRIX  CNXN) 

C  U0=  GAUSSIAN  DISTRIBUTED  NOISE  VECTOR  CNXl) 

C 

C  AND  THE  OUTPUT  EQUA’ION 

C 

C  YT  ~H*X  T 

C 

C  WHERE  VT  =  MEASUREABLE  OJT=>JT  VECTOR  C  MX1  I 

C  Hr  STATE  TO  OUTPUT  MAXTRIX  C*X“’> 

C 

NP=N  *1 

IF  C rRAGEM.C0.2»G0  ’0  4CC 
C 
C 

vDOTs  -1000.  * 

YOOT  =  0. 

/UOT=  0. 

XP03=  XO  ♦  XOOT*’’IMC 
YPOS=  YC 
ZPC3-  7Z 

VT I ME  =  TI ME- CD' /2 • 0  ) 

IFCTIME.LT. 2. C )GH  To  3 1 C 

XOQTr  -10  00.«CQ:.  (TRATE*(VTlw;r-2.)  ) 

YOOT  =  10C0.*SirCTPATE*(VTIME-2.)) 

XPOS=  X3-20CC.-C  <  lCf  /T°  A  TE  )  •  3  IN  CTEATE*<tIME-2.)  >  ) 

YfCS-  Yu  ♦  C(lQ3G/TRATE)*(l.-C03CTRATE*CrlME-2*) )) ) 

ZPCS=  ZO 
31 C  CONTINUE 

'HOP-  XPOS*»2  ♦  ZPOS**? 

,  ANGt=  EHCF  ♦  YPOS**2 

UMlfl):  <-ZP03*XD07  +  XPCS*73CT)Z«RH‘<'  *.0  0  0  02  ) 

PHCR -  SQRTCPHO'  ) 

UTC2  *1  >  =  (PHi’S  * YDOT-YPQ3*  <  C  X  ’  OS* XOQT  *ZP3 S  *ZDCT  )  /RHOR  )  >/<  R  ANGE 
**.00  CO?) 

RANGES  SOR' C-’ANGE) 

.  VMAX  =  SQPTCX0uT**?*YD0T**2*7aC,r*  *?)/<  5  A\|GF  *.  0  f?  00?  ) 

GO  •>:  401 
C 

40C  CONTINUE 
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C  -EAD  I n  r HE  0A7A  FRfM  THE  EKTE’MAL  APE 

C  AND  ‘iTflRF  THE  DATA  THE  MEXT  4UN 

C 

ifcni.ne.i »go  *o  4C2 

‘  FAO<?,*  >  ITf’tEXUTCl  ,NP>  ,EXl)T<  ?»NP>,VMAXFX(NP> 

*  ,C03W<NP>  ,PA'(EXC'iP)  ,T  IMEVCM3) 

40  5  F  JR  MA”  <  I  4  »6L  l  4  ) 

,-EADO  ,*  >H51A(flP>  »H::iHC;P>tH?2A('JP>  VHS20(NP>  »HS3A  CN°)  iHj  TfJ<'P  > 

404  FORMAT <6E14- “) 

•^EADO  »*  >  XP«J  :,yP0:,ZF0S»XD0T  tYOO^t/DOTiTPA'E 
40  *:  FOP  MAT C7E14.  .  » 

C 

vPITE(6»411 ) 

411  FORMAT  C / / »  T 1 »  *  F=AME*,T12»*  AO0T*fT2O,*  HOOT*»r40,*  VMAX*t 
>’-:i»*R0LL  A?  GLE*»T6<*.*c'Af:GE*,T92,*  E*  TI"E*> 

WRITE<6t4CG)ITEi*EX,JTCl*':P)  .EXUT  (2  »NP  )  •  VM  AXEX  C  NP I  «  CC*3  U(  ‘P  ) 

«■  ,PANEX<NP  >»T:f«EX(NP> 

40r  FUPMATU  X*!4,6E14.5» 

C 

WRITF(G»412) 

412  FORMAT (TO  »*  HSlA*»T21t*  H31 3* * • 3 3 , * H>2 A* , T49 » *HS2 B* t T 63 » 

*  H3  jft»,  I  77,  *  H03B*  ) 

MPITF.C6,4n7)H31A<NP)  .  HG1  Hf N? > *  MS? A <NP > » H3 2H < NP>  ,HS3 A  CNP )  »H3  3B(Nr>l 
4C7  FOPMATC1X ,  OF  1 4  •  5  ) 

4C2  CONTINUE 
C 

UT(l,l)  =  EXUr<l  ,rja  ) 

UT(2 *1)=EXUT(2 ,V > 

VMAX-VHAXEX(EP» 

BAf,6F  =  P.Ai.rX«  .4) 

C 

4C1  CONTINUE 

C  * 

c 

c 

CALL  NOiSEC 'EM°1 tN) 

CALL  MJL T ( OOP  CO T , TEMPI ,N , 1 , TEMP? > 

CALL  MULTIPHlTfXT  ,fi,N,l  ,  TEwPl  » 

CALL  MULT(BO,UT,3,2»l»rFMP3) 

DC  1  1  =  1 

1  XTCI  ,1  )=  TEMP1  C  1 , 1  )  TEMP  2(1*11  'EMPJ(Itl> 

CALL  MULTCHtXT  »M*N,1 ,YT) 

RET'  RN 
Ef  0 
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'  JUTlNt  If  ITF 


74/74  CPTrl  PMDMP 


FTN  4.A+5C4 


1 


'UBKCUTILE  i.LI7F<TAF»VARDF«VARAF) 

THI  3  ROUTINE  CC.NTPCLS  IMPUTING  VALUES  NEEDED  FOR  THE  KALMAN 
-  FILTER 


AF=.C70  72 

THIS  IS  THE  COR PEL AT l .?N  TIME  FOR  THE  ATMOSPHERIC  MODEL  FOR  THE 
-  FILTER 


THE  VARIANCE  OF  THE  DYNAMICS  FOR  THE  FILTER 


REA'Moi  2  )'/A-DF 
WR I  T E  <  6  »  I  )  V  AK  DF 

F  0  A  T  (  I  X  *  *  V  A  R I A  N  C  E  CF  FILLER  D  Y  fjAM  ICS**E14.5> 
UR  i  T  E  ( C  «  3  ) 

F0P  MAT ( 1 X  »  *  V  API ANC  E  CF  FILTER  ATMOSPHERICS*) 
pEAOC5*»2)  VAPAF 
F0PMAT(F7.4  ) 


THE  VARIANCE  OF  the  ATMOSPHF* IC  JITTER  FCP  THE  FIL'ER 


r-.ETU^  rj 
E'  0 


i 
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hjtzne  f:l*: 


74/74  CPT  =  1  FMOMP 


♦  564 


SUB- OUT  :NE  f:  LT'.RC  TOF.  VATD"*  r  AF»  VARAF,D’  *ph  if,  QFD»Nr  ) 
JEAL  PHI F ( R  »  )  »TFDCR  *?l 

INTEGER  'i 


THIS  SUBROUTINE  DEFINES  THE  FILTER  STATE  TRANSITION 

n "  l  i=i,  a 
rr  l  j=i.<> 

DHTF(I,J)=T. 

QFDC  I  «  J) -.0. 

CONTINUE 

PHIFC1*1»=1. 

PHIFC1,5>=D 

PHI F  C l  »“:)  =  (’  QF**2)*<  (OT/TOF>-l»SMEX’C-Dr/rDF)>> 

FHIF (2*2 >=l. 

PHIFC2,4)=ph;FC1 ,3) 

>"  H I  F  (2  * 6  )  =F-H  i  F  ( 1  »5> 

FHIF<3»31=1. 

PH IF (3»5 )  =  T OF* ( l .-EXP (-OT/TnF  >  > 
r  HI  F  (  4  ,4  )  =1  • 

PHIFC4»6)=fh:FC3,5 > 

FHIF(5t5)=EXPC-DT/T0F ) 

PHIF<6t6 )=PHIF(5,5) 

. PHIF(7,7)=EXP(-OT/TAF) 

PHIFCH»S )=PHiF«7f 7) 

v  A  T  P  T  X  (  P  H I F  )  A‘’Q  THE  DISCRETE  ‘dlSE  COVARIANCE 
MATRIX  CGFD> 

CFO  Cl  ,1)  -((2*VA^0F*TDF*<D7**3)  >/3.  >- C  2  »  V  A  RDF  *  C  TDF  *  *2  >  *  C  D  r  *  *2  » 
♦)-(4*VA®OF*C  DF**3)*l}T*EXoC-DT/''0F))M2*VAf,DF*CTDF**3)*DT)-VA<s0F*C 

♦  rDF**4)*EXP(-2.*nT/TQF)MVA3DF*f  T0F**4>  > 

QFDC  I  »3)  =  (VA'-'DF*  TDF*  <DT**2>  >  ♦(  l  *  VA  3  OF  *  (TDF  »  *  2  )  *D  T  *EXP  C  -DT  7  7  OF  )  >*C  V 

♦  AROF*CTOF**  3  I  > - C 2  * V A? OF  * C  TDF *  *  3 »  * E XP C-DT/7DF >  >-C2  *V  ARDF*  «  r  OF  *  *  2  >  *  0 

♦T  >  ♦  CVAPOFM  TDF  **3  )  *EXP<-2. *DT/*  DF)  )  * 

QFD (l  »5»=C-2 •• rOF*VA=nF*OT*EXP(-DT/TOF> > ♦ f VA P OF* < TDF * *2 > >-CVAROF*C 

♦  rDF**2>*FXPC-2.*[)T/TDF>) 

OF  D  (  2  »  2)  =OF D  C  1  »l  ) 

QFDC".  » 41  =  QF*D(  1  ,3) 

QFD (2  » 6 > -QFD C 1 *r> ) 

QF0C!.,1>=0FD<1  «3  ) 

OFD<  I  *3)  =  (2.  »VAf'DF*T  UF*DT  »-(  3.  •<  DF*  *  2  >  *  VAR  OF  )  ♦  C  4  .  *  C  TDF  *  *  2  )  *  V  AROF* 

♦  EXP  (-DT/TDF  ))-((  TDF  *  *2  >  *  VA  *  3F  *  £X  o  C -2  .  ♦DT/1' OF  J  I 

QFDC  3,51  =  (VA- DF* I  OF  I - ( 2 . * V A R DF * T DF*EXP C-DT /TPF ) ) ♦{ VACDF* TDF *EX PC-2 

♦  . *DT/r  DF ) } 

QFDC  4i2>  =GFD(2  *'♦) 

QFDC  4  ,4) =OFD( 3  »3  > 

0FDC4,6> -QFDC  5,'5) 

QFOCf>»i  » -  QFUC  I  o> 

QFDCN  *3) = QFDC 3  * 5) 

QFD  C  c»  ,C )  =  VA‘  DF  *  C  1  .-E XF ( -2 . *1 7 /  I  DF  )> 

QFOC- »  2) =  QFD<2  »6  > 

QF  D  C  S  •  4  )  r  QF  U  (  4  » 6  ) 

QFOdiG) -QFU(5*S> 

OFDC7.7)  =  VA'AF*Cl.-EXPC-2.*DT/TAFn 
QFDC  ,Q>  -QFDC7,7> 


WRITE  THE  MA'7IX  DEFI M  Tl  2*.1  S  TI 
rFCN'-.N'E  .1  )G;  TO  20 


THE  OUTPUT  7 APE 
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74/74  fl?r  =  l.  FMOf,lP 


FTM  4.~*56 


::  up. 3  :ut  i  *. c  p ■  ? p -  (  ph :  f  *  qf d * Pr  p •  =  f  *  . xf r  ,  xf " •  vs  •  sv pf p *  i ch > ) 

PEAL  r  H I F (O  »  )  »7PD<  , -O  *  °f- P  (  -  ,  -  >  *  DF  V{  f>  ,  )  ,xrP  C»  >  *XF*  C3  > 
.F.AL  PHIFTC  •«-  )  «  *EMPl<-»  •)  «  EM»2Ca#‘sl 
•EAL  SVPFPC-,  ) 

I  *i  TE  HEP  ICHN 
C 

c 


j 

c 

c 


I 

] 


THIS  ROUTINE  I-v>PLEFF*'TSm  THE  S  r  A  T£  to  ANSTTIOA' 
-EQUATION'S  F Cu  THE  FIL'ER 


XF ( :♦!) =PHIF*XF< I » 


PM=PHIF*PFP*rHIFT  +QFD 


WHE^E  PHIF  =  F:LTER  STATE  rP.AN~. IT  I  ON  MATRIX 

XF  =c I L  TER  STATE  VECrOR 
PFM  =cr..v  PILTER  STATES  MINUS 

PFP  =cov  filter  states  plus 

QFO  =  NGIS-:  CCVATIAiCE  MATRIX 


PERFORM  FIL-ER  STATE  PROP ABA ' T ON 


CALL  MULr<PH;F*XFP,3,f  *1*XFM 

CALL  MUL " ( PH  IF  »PFF  *  •:? » P  * :?  * r  EMP1  )  4 

u:  l  1=1*3 
0  1  1  J  =  1 »R 

PHIFT<I*J>=PHIF<J*1  I 
CONTINUE 

CALL  MUL  T  (TEMPI  »PHIFT  »S»S*0*TEMP2) 


SAVE  PHIF*PFP»PHIFT  FOR  QFD  FSTIHArtCN 


IFC ICHQ.ME. I )GO  rC  377 
Of  3  76  1=1*-* 

U*  376  J  =  l*^ 

SVFFPC  T  *  J ) =  FMp2<  I*J> 

376  CONTINUE 

377  CONTINUE 

C  WR  I  7E  ( 6  »  36  J  ) 

36  FORMAT (  *  TEMF2*> 

C  CALL  MPiJ  IN  I  (  f  EMP  2* ?'  *  *  *  1  3  1 

C  VIP  I  TE  C6  t  370  ) 

370  FORMATC*  QFU‘ ) 

C  CALL  MPf  INT(QFD«8»f  *10) 

TF( N  * • NE • 1 )  GO  TO  3  7  4 

C  WR I TEC6  *  3  71 )  C (PFP C I  * J> * J=1 • 5 ) • I = l *  3 ) 

371  FORMAT  <lX»*PFP**/*<  IX*:: El  4.5)  ) 

374  CONTINUE 

0?  2  1=1*? 


74/74 


I P  T  =  1 


FTM  4, 


10/ 


no  .?  j=!»  > 

PFMC  «  J>=  •  E^’-V  C  I*  J)  >flFO(T  *  J) 

cnnrp.uE 

!FC'~.>!E.i>  00  r>;  373 

WPITEC6.3/3I  C  (^FM(  I,  J)  ,J  =  1»?  )  ♦'  =1  *<1> 
FORMAT  <17  *//.  *  ^FM*  ,/,  (  IV  ,  HE14  .  :>)) 
CONTINUE 

t.e  ru-  m 

0 


>umE  ifpurj 


74/74  CP  7  =  1  PHOM:' 
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SUBROUTINE  INPUTS*  IKAXtStXHB  X.  \l » X , Y , DA T A . CE” X *CE NY , YMA * » 

*SIGM3  (RA.  .GEO  »*A'.GE*UT  *  VMAX  »  A  3  PR  0  *NUMHS  1 
REAL  I N AX <  3 >  »S(l2)tXMAX<3)»YMAX(3> 

CCHPLEX  OATACN*'J» 

REAL  SIGMS»f ANGEDtRANGF* VM AX , ASPIC 
*  EAL  UTC2.1) 

INTEGER  ONEH 

THIS  ROUTINE  DETERMINES  =?  E  A  L  MODEL  INTENSITY  AND  CENTROID 
VALUES  FOR  AN  RX3  PIXEL  FOV.  ZERO  ^ADDING  IS  ACCOMPLISHED  BY 
CENTERING  r  HC  2  XE  PIXEL  F^V  WITHIN  A  NULL  *!  X  N  SPACE. 

THE  CEO- 01  NATE  SYSTEM  IS  AS  DEFINED  BELOW: 


(  0  »  <1  ) 


It 

GAUSSIAN 


C  X » Y  1 . . 

.  FOV  . 

It  ». 


THE  N  T  F  N  S  I  “  Y  PATTERN  IS  DEFINED  TO  BE  3  GAUSSIAN  DISTRTBUTION~ 

OF  INTENSITY  I  MAX  C  I  »  »! -1 1  3  LOCATED  AT  XMAXC)tYMAX(I)*T  “1*3 
WITH  COVARIANCE  S(I)»I=1*3.  ME  UPPER  LEFT  COPNFP  OF  THE  8X'  PIXE 
FOV  IS  OEFI’.EO  r G  BE  LOCATION  X»Y  MICPORAO. 

THE  I  MEL  S  ITT  AT  EACH  PIXEL  IS  OE'EPMITiED  BY  INTEGRATING  *  HE 
INTENSITY  :h  23  EQUALLY  SPACED  SPOTS  WITHIN  THE  PIXFL. 

,:IGPV  =  3IGMS*  Cr.  ANGED/ '  A'JGE  ) 

PLVEL=SORTCUMltl)**2*UT(2»l>**2> 

SNTH=UTC  2»1 > /PLVEL 
CSTHrUTC  l.D/PLVEL 

SIGV=Cl  .♦CASP£JC-l  .  I  ‘PLVEL/VMAX)  *  3IGPV 


ZERO  OUT  FOV  SPACE. 

00  10  I=l» 

0"  13  J=l* 

DA" A  < I »  J  )  =  " . 

SUM  *  =0 . 

SUMY -G. 

SUM A VG=  r . 

LM  =  "  7  2-1 
LP  =  'i/2*4 
00  1  IcLM,Lt- 
00  ?  J=LM,L 
AVG=S. 

DIVIDE  PIXEL  ItJ  I.*irO  2  N  LEGMEN’S 
DO  3  Kl=lo 
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’Un»E  i^cu’i  7A/M  CP7  =  1  PMOm:> 


FTN  %.P«-5SA 


or* 


70 

71 


4 

5 
C 

m 


l 


DO  4  K2=1*F 

DEL Y  =  <!-;>* l.C ♦  CK1- 1  )*. 2 
OEL>  =  (  J-9)  *  1  •  0 ♦  CK2**l  )  *  «2 
.  XP  =  X«>DF.LX 
YO=Y*OELY 

CX1=(XP-XMAX<1 )>*CS  H 

:xi  =  (XP-xMAxcin*Sfi'  h 
CY1  =  < YP- YMAX ( 1 )»  H 
> Y 1  =  (  Y P -  Y M A X  <  l  > )  *  3NTH 
XI =C  Xl ♦SYl 
Y1 =C  Y1 - jX 1 

APGi  =-.5*  (<  Xl/S :r,V)*  *2  KYl/n  I  SPV)**2» 

IF  I'.UMHi.FQ.nG';  t r  7c 
CX2= (XF-XNAX (2) > *CSIH 
CY2=CYP-YMAX(2))*C3TH 
:X2=(XP-XMAv  C2» )*SN"H 
?Y2= (YP-YMAX (2 ) >  *3NTH 
CX3=(XP-XVAXC3>)*C$7H 
CY3=(YP-YMAX(3)) *C3TH 
3X3-(XP-XMAX(3)  »  *SfirH 
<Y3  =  CYP-YMAX(3>>  *  SfJTH 
X2-C  X2 ♦S  Y  2 
Y2=C Y2- 3X2 
X3=CX3«-SY3 
Y3=CY3-5X3 

ARG2=-.~M  CX2/3IGV) **2M Y2/SI SPV > * *2 > 
AGG3=-«5*((X3/SIGV1«*2+(Y3/SI3P'M**?> 

FXY=IMAX(ll*EXPf ARGll*IvAXC?)*ExPCA3G2>*lMAX<3>*EXPt APG3» 

GO  T  C  71 

FXY=IMAX(1)*EXPCARG1> 

CONTINUE 

AVG=AVG+FXY 

3UMX  =  SU!WX*XF  *FXY  * 

GUKY=SUMY+YP«FXY 

CONTI  fit'E 

continue 

OATACIt J)=AVG/23. 

VR! TECS »10C )  I* JtDA^ACIfJ) 

FOF.r'A7<2Xf2i'»  »2XfE12.’3J 
3UMAVG=:UVAVG^AVG 
CONTI  HUE 

continue 

CF.NX=SUNX/?UMAVG 
CF.UY  =  SUMy/7UKAVG 
’ET’JR'I 
CO 
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UTINE  CLRi-EL 


74/74 


C»T=1  p  M  Q  M 3 


FTM  4 • p  *5  6  4 


C 

C 

c 

c 

c 


35 

2 

C 

C 


31 

C 

u; 

c 

20 


SUBROUTINE  C  EMN-'  »DATA,  rv-LftT»  XCf’ir,YCE'iT,X«YtTH=>CSH, COO’D 
COMPLEX  r  MPL  ATC24#24)  ,OATA(24,24) 

COMPLEX  TEMP I  24*  24 ) 

COMPLEX  y.:iKCE0> 

HEAL  RO  A  T  A  1 2  4  »2 4  ) 

EAL  MAG 
r  N  TE  G  E  P  COP  L 
I ’» T EGE  V.IO) 

*H  1 3  SUB"  OUT  i  ?.E  IMPLEMENTS  C  OR  TELA  T I  ON  METHODS  IN 

FREQUENCY  DO  U A I M  *  I • L . THE  FFT  A' D  PHASE  CORRELATION 
METHOD.  IF  r HE  DIRECT  METHOD  IS  BEING  USED  SUBROUTINE 

r.F(C0»RL.GT.2)CALL  CC  RL2  I  NN  »  0  A  T.A  *  T  MP  LAT  *  XCEN  T  •  YCENT  ,  X  *  Y  »  CORRL  ) 
IF CCORRL • GT •  2  )  GO  TO  20 
CALL  FQUPT  IDATA»NN»2*-l*l*WOR<T 
DO  1  1=1*24 
DO  1  J=l»24 

TEMPI!  *.l)=Cv  NJGCTHPLATCI,JII  *  DAT  At  I, J) 

;F(CvRP,L«NE.2»G0  to  1 
XM=REAL(4 TEMPI  I  *J>» 

YM=AIMAGITEMFtI*J) 1**2 
MAG=5QRTIXM*YM> 

IN  ORDER  TO  AVOID  NUME° 1  CAL  DIFFICULTIES  THE  MAGNITUDE 
IS  CHECKED  BEFORE  THE  DIVISION 
IFIMAG.LT. .OOOOOOOODGC  "0  101 

TEMPIIt J>=TENPII , J)/vaG 

GO  *0  1 

*  EMP 1 1 » J ) PCMrLxC 0 • *  C • ) 

CONTINUE 

CALL  FOUR  T IDATA  »  NN  *2*1 »l*UOP<)  '  * 

CALL  FGUPTI ' EMP *NN *2 *1 *1 #WDPK > 

IFIC ORPL.EQ.PIGO  tO  22 
O1.'  35  I  =1*24 
f)  35  J=l»24 

TEMPII»  J»=TLMP(I  ,  J>/576. 

DATAII ,J)=OA All  * J>/576. 

CONTINUE 

CALL  OISPLAY<24,24 ,DA'A) 

CALL  CHAQUAOITEMP,24 ) 

CALL  DI SPLAYI24.24 fDATA) 

00  31  1=1*24 
Oi  31  J=l*?4 

POAIAIIf  J)=‘  t  ALt  TEMPI  it  J)) 

WR!  .'E  IS  *112)  IIP0A"AirtJ>*J  =  l,24),r=lt24> 

FORMAT! 411 x ,GE1 2.5*/) ,//> 

CALL  CEN  TRD!X»Y*TEMp*2'>  *  XC'EN  T  *  YCEN  T*  THRESH) 

CALL  Dl3PLAYI24*24,UArA) 

CONTINUE 

XCENT=XCENT-.5  * 

YCEf!  T  =YC£ti  T  -  .5 
WR  I TE! f  » 1 10  )  XCENT  »  y CF  NT 

FOPrATf 1 Xt*CENrFOIO=!**F7.?,*f *,F7.?  *•)•  ) 

XCU'l=XCUi'f*C  XCENT-XoHIF  r  I 
YCUM=YCUM*  I  YCEf JT-Y  SHIFT! 


n  o 


r»  n  n  n 


UT Iff  C-  -Li 


7*1/74  001=1  P.MO*-*F 


FTN 


'UHR5UTT  -It  CO  5  L?  (  NN  ,0AM,*  M?LAr,XCE‘"'’»YCENT»X»Y»CCR0L) 

C 

COMPLEX! -’PL  A  "  <24 .24  >  »  UO^KC  S'?  >  *  DA  '  At  2  4  *24  )  tHCLDTC  24,2*  > 

-EAL  C0RC24  *14)  ,QNT  C2  4  ,  24  )  *ONO  C2  4 ,24  >  «  'E  VP  (2  4  .24  >  ,SU*MCl  T#17> 
>F.AL  VAC24.2'.  >,  MEAN  T(  24*24), VARM24, 24) 

EAL  A(24  ,24  ) 

INTEGER  vN<2> 

'  MERER  COP,;  L  »  PMAX,  Q**AY 
INTEGER  P  *  0  »  r  3  ,0  3  » *■•  1 
EAL  01*0? 

'.MTEGER  05, r'; 

-EAL  MEA‘  0 

'HIS  SUB 13  OUT I  ME  IMPLEMENTS  THE  DIRECT  CORRELATION  METHOD' 


e>? 


31 


2  k- 


25 

C 


27 

C 

C 

C 

C 

C 

c 


1-4 

H'L01=0. 

401=0. 

102  =  0. 

TCT  AL  =  0 • 

HOLD2  =  0.‘ 

2UMX=0 • 

sumy=o. 

SUMA=0. 
no  31  1=1,24 
0?  31  J=l,24 
A(I*d>=0. 

VARMI  ,d>=0. 

V  A  ( I  «d )  =  C  . 

CONTINUE 
0=0  • 

VB=0  •  i 

O'  2f.  1=1,17 
D.  20  J=  1 , 1  7. 

II=’-1 

JJ=J-1 

5U  M'*  ( 1 1 ,  dd  )  =  r  . 

CONTINUE 
D>  25  1  =  1,24 
O'  25  d=l ,24 

HOLOTC :,d)=TMPLA7 (I,d> 

CONTINUE 

CALL  FOURT (H5L07 , UN, 2,1  ,1  ,HRR<> 

O':  21  1  =  1,24 
0"  27  d= 1 ,24 

HOLOTC I ,d)=HOLOT  C I ,d> /57S. 

COOT  I'lUE 


THE  MEAN  FOR  THE  DATA  T2  CALCULATED  ONE  "IMF 

’HE  MEAN  FOP  THE  TEMPLATE  IS  CALCULATED  FOR  EACH  P,Q  VALUE 

THE  VARIANCE  CALCULATIONS  ARE  ONLY  PEQUI9EO  FOR  '  HF 

THE  o-LEVEL  QUAN I T IZ/ER 

DO  3C  P 3  =  5 , 1 3 
DO  30  03=5,13 


u  r  r  f  e:  c  3  l  ■? 


m//a 


’ - T  = 1  PV3M3 


F-’fi  4.S+1G4 


10 


3* 


•1  =  03-1 
Pr'-’J-l 
f)  1  1=1#', 

0  1  J=1,C 

C 

A<PfQ)=ACP»0)*,(R£AL(H0LDT(  t*P»J*Q))  > 

FlC"'3?.  L»E0«'‘)VA(P*Q)  =  VA(D*9)*REAL(H’L0r(  I*P*J*Q))**1 

IFC-l.NE  *♦>«<■  *9  121 
H=B*  (REAL  CDA  A  ( I  ♦<?.  .  J*  i  I  >  1 

:F(C0RRL.EQ.'»  >VB=VB*  (PFALIOA  r  AC  *3  *J«-9  I)  »  **2 
ttl  CONTINUE 
C 

1  CONTINUE 

C 

VEA‘iT(P,0>=A<P*Q)/G*.Q 

tFCC  OR  RL»EQ»':»)VARTCPfQl=<i(lRTCA3~((\/A(P*fl)/<iA«0)“CMEANTCPtQ)**2))  » 
IF(iM.NE«4)G';  TO  12  2 
MF A  0=0/64.1 

T  F ( COR  RL • EQ#  4  >  VA  c  0=  SQR  T  <  ABS (  (  V3/G4. 0  >  -  (  ME  A‘:D  *  *  2  )  >  > 

122  CONTINUE 

I  i  1  =  N  1*1 

3G  CONTINUE 

C 

IFCCORRL-.EQ.'UGO  to  ° 0 
C 

C  CALCULATE  THE  QJANITIZED  VALUES  BASED  ON  '"HE  MEAN 

C  CALCUL AT  I ONo  F 0K  THF  2-LEVEL  QU*iATIZE» 

C 

DO  15  03=5 t 13 
DO  15  P3=5» l t 
Q=Q3-1 

P=P  3-1  , 

DO  1?  J:lt6  * 

DO  1 6  1  =  1  * 5 
C 

0NT(l4PtJ*0>=-1.3 

IFIPEAUHULD  '(  I  *■?  *  J+H  ) )  .GT  •  ME  AN  r  (  p  ,  Q  )  )  Qf>  T  CI«-P*J«-0>  =  1.0 
3  NO  C  I  *8  t  JT'O  )  =  — 1  •  D 

IF  (REALCOATAd*11  ,  J*0  )  I  •  GT  .  ME  AND)  ONDC  I  *9  » J  ♦  «  >  =1 
SUMM  (P  ,  Q|  =  ~UMM(P»  9)  ♦Qf.T(I  *Pf  J*Q>  *QND(  I*R  ) 

1G  CONTINUE 

C  CHECK  FO e  THF  FAX  CORRELATION  VALUE 

I F  « SLMMCPtO) .LT.TOT ALIGO  ”C  51 
PM AX=P 
Q"AX=Q 

' 0  T  A  L=  OU MM ( P  t  0 1 
O1'  3  I  =1*5 
DO  3  J=l»»  ' 

C0~  <I«-pMAX  *  J«-OMAX  >  =  (Q‘|  "(  I  *PMAX»  J*QMA*>  *QND  (  1*3  *  J*R  U/'GA.O 
3  CONTINUE 

51  CONTINUE 

15  CONTINUE 

GO  TO  83 
EC  CONTINUE 

C 

C  PERFORM  the  CALCULATIONS  Fr3  THE  G-l,EVEl  QUANTIZER 

C 
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n  n 


■UTlf.E  C1'  4  L  2 


74/74 


PT=1  PH!J«P 


F^r  4.P«-t;64 


10 


DO  17  Q1;.  -  5  ,  l  5 
U~!  17  < 

=  . 

HD2  =  . 
p  =  Pc>-1 
0=05-1 
D  1.  J=l»u 
0  l-  I=t»d 

01  =  <;  F1AL  (  HOLD"  f  P  ♦  :  ,U*  Jll-MEA*  TC  p*  Q>  )  /VAP  '  (P»  0) 

ifcqi.g:.  ioo  ro  i. 

ONrc:«>p.j»Q>--i.' 

IFC01.ET.-..C  >0?.T(I>FtJ»0)  =  -3«2 
rFCQl.LT  .-i  .41  Qr»T(  I  +  P*J«-Q  )=-%*! 

GO  ’0  a.2 

GNT  < i +P* J+0)-l .n 

!F(Ql.GT..C»G'lr  C  I*r-tJM)>  =  3.3 
I F  <  Q l . G  T .1 . 4  >  Q  v TC I *P . J^Q  >  =  ft. 1 
CONTINUE 

02  =  (REAL  COAT  A  (I  *6  *J«^  >> -ME AND> / V A? 0 
'FCQ2.GT  .O.t  )  GO  rr)  /  j 
•>M>(  !♦** J«*rt>  =  -i.O 

IFCQ2.L  .ft  IQ'jOCI*  ’  *J»3  )  =  - 5.0 
IF<Q2.LT  •  —  1  •  4)  QND  (  I  »J*3 )=-S.O 

GO  T2  P4 

OND(I«-3*.J*£)  =  1.0 
*FCQ?.GT  .O.ft)0'OCI»r  »  =  3.0 
iF(Q2.«r.i  .4  xr.nc  i*a  tj«*«  >=ft.: 

CONTINUE 

HD1 =HOl >ONT (i+P»Q*J)**2 
HD2  =  HD2«-G\DCI«-P»J*P  )**2 


12  CONTINUE 

DC  36  1=1*9 
17  3ft  J=1*M 

CUMMCP»Q>  =SUMMf  P* 01* (OUT  CI»3  ,  J*Q)  ONOCI*  i  n/3QRr  (HD1  *HD2  > 

3d  CONTINUE 

[FCSUM^CPfO)  .LT.TrjT  AL  )  GO  r0  52 
C 

T  0  T  A  L  =  3U  M  M  C  P 1 0  > 

»MAX=P 
QI*AX=Q 
H  L01-H01 
H  * LD2=HD? 

C 

D'  5  1=1 »P 
D.  5  J=l»r! 

CC3<I*PUA'f»J*OMAX)  =  <QNTCI*’PMA>(*J«'QMAX)  *ONDCI»B  »J«-P  > > / C SQR r < HOED’ 
••  *HCLD2  1  ) 

5  CONTINUE 

52  CONTINUE 

17  CONTINUE 

S’-’  CONTINUE 

PS  CONTINUE 

C  WRITE(6*ft2)PMAx»QMAX 


«1 


r  2 
C 


W 
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JUT  r  f  E  C C, 0 L 2 
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opt=i  pvp«? 


FT  N  4«f<*5e.4 


10 


£>2 


FORMATClXi*  =  f)MA’=*.I4> 

D'  6  1=1.8 
11*  *  6  J  - 1  *c! 

3UHX-SUKX*FL0AT  Cl ♦PM AX) *C!!P( I ♦PMAx » J+QWAX) 
SUWY=3UMr  +  FL0AT<J>flMAX>*C01»  (  [  ♦  3  MA  X  «  J  +  QF’A X  > 
3UMA  =  3UMA*C0r  (  I+Pf'AX  i  J*  Q M A X  ) 

CONTINUE 

XCEN  TaGyMX/3Uf*A»X-8  .0 
YCENT=SU/4Y/iUMA*Y-']  .0 


pETUkN 

ENO 


n 


s  ®? 

* 


n  n  n 


•Urir.E  CF. NT C  0 


74/7% 


GPT=i  PMQM3 


FT  !M  4^ .  r  ♦=i^  4 


10/ 


3URR  OUTIOE  CF'f:T:\DCX*Y»0ATA»''tX2E'ir*YCE''iT»THo.  ESH) 
complex  DArACr  ,^) 

THIS  3U0?0UT  If\F  PERFORMS  THE  C0-*cELArO7  THRESHOLDING 

AMAX=-1 . E39 
m  10  1=1 tN 
no  lo  j=i»n 

10  AMAX=AMAXl<ASAXt.JEAHOAr  A<  I  •  J>  )  > 

3UMA=0. 

SUMX=0. 

SUMY=0 . 
oo  i  :=!»’; 
oo  i  j=ifr 

IF  (9  EALCDATACI  »J)  >.LT.TH9ES'H*A*Ay>  DATACI*J>=9. 

SUMA  =  SUMA  +  i-EAL(nATA(I  ,  J>) 

3UMX=SUMX«-FLGAT  C  J)*REALCDAr  AC  I  ♦  J>  > 

1  SUMT  =  SUMY«-FLCAT  C  I  )  *REALCOAT  AC  I  *  J>> 

X CE  .\T=SUMX/3UMA.*X-9  •  5 
YCEf  i  T=SUMY/C UMA ♦Y-O .5 
RE TOP N 


4 
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UT  f  r  £.  CHAOJAO  74/74  i^Tsl  PMri»a 


suM'  ourrvc  chaouadtda  a.'*) 

COM'LEX  OAT  A  ( f  »  \  )  #  c,  A  VE  l  »  *  A r  ? 
N2  /  2 

no  1  1  =  1  *  ^ 

00  1  J=l,  ' 
jAVffl  =QA  ’  A(  :  ♦  J) 

DATA(I*J)  =  l)A'AC12*!»1,2>J) 

OAT A(1 2  +1 1 1 2* J>  =  3AVI 1 
3  AVF2  =D  A  A(  1 2  ♦!  »J) 

DA  rA(l2>I  »J)=OATA(  :,1'2«-J) 
DAT4U»12«-J)=SAVE2 
CONTINUE 
RETURN 
E'iO 


o  o  n  n  n 


1UTINE  SMOOTH 


74/74 


>  n  r-  i  pt'QVs 


FT  N  4.11  «oS4 


iUH^TUri't  \"J*  rH(OATA,5DATA  ,Ai.PHA»  N*  I  TE=  AM 
COMPLEX  DAT  A ( N  »N )  .SDA'AdJ  .  > 

THIS  ROUT!  E  "f'OCTHS  eAW  DATA  ARRAY  DATA  USING  EXPCNEN '  I AL 
SMOOTHING.  WEIGHTING  FACTOR  ALPHA  I "  USED  T  O  GEflF?  ATE  THE 
SMOOTHED  DATA  IN  ASF  AY  SDATA.  THE  PARAMETFR  ITERATION  I' 
USED  TO  DE  EFVTME  THE  WEIGHTING  FACTOR  WHEN  FEWER  THEN 
1 /ALPHA.  ITE»  ATI  rUC  HAVE  BEEN  D'VE. 

A=1./ITEK AT 

I F  C  A.LT .ALPHA )  A=ALHA 
1  DO  3  1=1, 

DO  3  J=  1  » N 

SDATAd  »J)~A*DATA(IfJ)*(l.-A>*SDATA(I«J> 

return 


3 


jurrr.c  ept*’ 


74/ 74  OPT  =  1  PM!)«3 


FT V  W*56  4 


C 

C 

C 

C 

C 

C 

C 

c 

c 

c 

c 

c 

c 


50 


36 


SUBROUTINE  5  P  T  N  C  S I G  v  A  H  »  ,M> 

Dr  PENSION  <64  ,64  >  ,C<5  > 

OA ’ A  C/.367°,.243l,.1353,.106?,.C51/ 

SET  UP  SPATIAL  NOISE  CQ8?ELATI0N  COEFFICIENT  MATPIX 
USING  SECOND  NEAREST  NEIGHBOR  CORPELA'ION. 


C  13  I  HE  Ar; PAY  CONTAINING  T HE!  NON-ZE^O  ELE FEN T  S 
CGSREI  PONDING  TO  THE^  DISTANCES  TO  NEIGHBORING  PIXELS. 
THE  A  AY  VALUES  AFC  EXP(-DI3TANC£  IN  PIXELS) 

GIGFAB  IS  THE  BACKGROUND  VARIANCE 

P  IS  THE  X. *2  BY  H**2  CORRELATION  MATT  IX 

2 

00  30  1  =  1,'! 

DO  30  J=l,*, 

:‘(I*J)=c.Q 
CONT  I.’lUt 
DO  36  1=1, 
r  (I  ,  n  =  i . 

IF  CI.GE.64)  GO  to  36 
CI*t*t)=CCl> 

IF  CI.GE.63)  GO  TO  36 
(I , I *2 ) =C  <  3 1 
IFII.GE.53)  GO  TO  36 
C I  ,  l*6)  =r *4 ) 

IFCI.GE.5  GO  TO  36 
Cl  ,I»7)-CC2> 

IFC I .GE.57)  GO  TC  36 

<I,I»P)=Ctl)  i 

IFCI.GE.56)  GO  TO  36 
Cl  ,T*9)=C<2) 

IFCI.GE.55)  GO  to  3b 
<I*TM9)=C<4) 

IFCr.GE.51)  fiC-  TO  36 
Cl ,1*14 ) =C  €5 ) 

IFCI.GE.5C)  S3  T0  36 
' ( 1 1  t*lb  >  =C  <  4 ) 

•IFCI.GE.4U  GO  ro  3 f 
" C  I  ,  1*16 )=C( 3) 

IFU.GE.4fU  GO  TO  36 
•  <!,[♦!  M=C<  4) 

IFC  .GE.47)  GO  TO  3b 
r  CI.IU  !  )=C<5) 

CONT I NUE 
On  37  I  = l » M 
i ca*;-7,p*i  )=o.o 
i*  C8  *  I  -7, 5  *1  - 1  )  =0.0 
RC8*r-6,.i*I  )=0.0 
IF  CI.GF.8)  GO  TO  37 
Cfl*I  ,B*:»1)=0.0 

c«*:»p*i*2)=c.n 

«cy*r-i,«*i*i)=o.o 

CH  *  I  — 7*  4  *1  *  T )  =0.0 
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37 

3 

39 


c  C‘.i*!-7, *i*  »=n.c 
9  C<3*  [-&#!*!♦  )='un 
:f  c:.ge. /»  go  37 
< <u*i .a* .♦9>  =c .3 
■  <3*1  ♦«*  r-^ip  >=r*.c 
-  <  •*r«-  ii=3.o 

' F  <*.Gf .F>  GO  C  37 
< .•=»  *  i ,  i*  :*i  r  >=c . f 
c  a  *  1  #  a  *  r*i  c 

*!*1 7)=2.C 

CONTINUE 
DO  3>  1  =  1*0 
=  1*1 

no  3  >  J=L *  V 
F(L.GT.-'I)  G'  TO  3c 

p  cj» : )  =  ’ ( 1 « j ) 

COUTIOUE 

00  3?  1=1*0 

n.:  5 o  j=  i»o 

6  Cl , J)=S IGMAH*  (l.d> 

t’E  TUC  N  . 

ED 


fP 

* 


f 
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)ur:*E  mcise 


SURR  LUTI  <"E  M?'tSEC-l*L) 

"'EAL  UCUI 

:  a=’ 

00  ?  I=l»‘ 

CALL  GAU'3  3CIAtIY  »  V  AL  ) 
WC I t -UAL 

!A=:v 

CONTINUE 

RETURN 

F.'D 
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4 
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FT'J  4." ♦SOR 


CP 


c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

r 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

c 

7 


tn 


2  r 
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SUB-’QUT  f.E  :Hif  T  CO.'T  A  »N  »  X C -U  FT  .  Y  SH I  FT  J 
COMPLEX  D  AT  A  { ■ ! » f.  )  ,TE'ipl  ,rr^  ;  ,  t  E  MP  3  »  f  EMP*  ,FX  »F  XC  »F  Y ♦ •=  YC 
rH I S  ROUTINE  IMPLEMENT  S  A  SPATIAL  PHASE  OHIF’ 

in  the  frequency  domain.  th-:  array  data  is  assumed  to-  me  *he 

NXfl  ARRAY  C.F  FOURIER  FRANS^M  COMPONENTS  AS  GENEPATED  MY  THE 
T  R  AMTFORM  ROUTINE  FOUR  T .  FO^  EXAMPLE.  FO*  A  6XF>  ARRAY  0  A  T  A 


c 

xo 

YO 

C 

XI 

YC  C 

X  2 

Y  3 

c 

X  3 

YO  CX2* 

YO 

CXI* 

YO  C 

c 

xo 

Yl 

c 

xi 

Yl  C 

X? 

Yl 

c 

X  3 

Yl  CX2* 

Yl 

CXI* 

Yl  C 

c 

xo 

Y2 

c 

XI 

Y2  C 

X  3 

Y2 

c 

X3 

Y2  CX2* 

Y2 

CXI* 

Y  2  C 

c 

xo 

Y3 

c 

XI 

Y3  C 

X  2 

Y  3 

i 

X3 

T3  CX2* 

Y  3 

CXI* 

Y3  C 

c 

xo 

Y2 

*c 

XI 

Y2*C 

X2 

Y2 

*c 

X  3 

Y2*r X2* 

Y2*C  X 1  * 

Y2*C 

c 

xo 

Yl 

*c 

XI 

Yl  *C 

X2 

Yl  * C 

X3 

Yt*CX2* 

Yl 

*CX1* 

Y1*C 

phase  shifting  is  implemented  by  multiplying  the 

FOURIER  TRANSFORM  COMPONENTS  BY 

EXPC  J*2*PICFX*XSHIFT«-FY*YSHIFT>  ) 

XS  HIF r  ANO  YSHIFT  ARE  THE  SHIFTS  IN  THE  X  AMO  Y  C  OOR  DT  N  AT  E 
DIRECTIONS. 


FI  r3.l41bS2e.54 
DEM=FLOA'CN» 

NCENT=N/2*1 
DO  1  1=1.  NCE.N  r 
no  I  J  =  1 *  MCE \T 

FX=CwPLXCQ.»-2.»PI*CJ-T)*KSHIFr/3EM> 
FY=CMPLX  C0..-2.*PI*{I-1)*YSHIFT/[)E'*> 
FXCpCONJGIFX) 

FYC  =  COMJG(FY  > 

rEMPL=0A1  A  C I  .  J  l 

DATA  Cl  .J)=7CiMFl*CEXP<FX^Fr) 

IFC  I. CO. I >  GO  TO  1C 
IFC d.EQ. 1.0* .J.EO.NCENT)  GC  TO  20 
TEMP.?=DA  '  A(  I  ,l>  +  2-J) 

TEHP3  =  DAf  AC  .J) 

TEMP4=0A  I  ACN+2-I 

DATACI*N*2-«M  =  rEMP2*CEXpCrXC*rY) 
1>ATACN*?-I  «J)=  TENP3*CEXPCFX*FYC) 
OATACM  ♦2-I»N*2-J)  =  TEMP4»CEXPCFXC*,FYC> 

go  i 

IFC  J.EQ.l.OH.J.EQ.NCENn  GO  '0  1 
TEMP2  =  DA  ACT  .N*2-J> 

DATA  Cl  ,N*2-J)  =  TEMP2*CEXPCFX:  *”  Y  ) 

GO  TO  1 

TEMP.3=DA7AC’>2-:  .  J) 

DATACN*2-I»  J»  =TEMP3*CEx=CFx^eYC) 

continue 

OCTU'Ti 
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UOilUTI*  E  F  'U'?(DA'ftiV!,vr  I  '  I  GN  *  I F  3  P  M  *  U  °  °  K I 
C  FOR  INF*V-MAT  :?;j  COf.TAC’  **’.  MA-'K  HALLE0  4  95C/A0D'  /5S24” 

c 

C  'HE  COOLE  Y-TUKEY  FAST  FOURIER  T  ^  A  NSF  0 Q  M  IN  USAST  BASIC  FOR'RAN 

C 

c 

C  ’  R  AN  SFOr  M  C  K1  » K2  »  «  •  •  )  =  SUMO  A  r  \  (  J1  *  J2  ,  ..  .  )  *E  XP  C  T  S  1  G»'*  2  *  P  r  •  SO  ' T  C-l  ) 

C  M  CJ1-1  )  *  (  K  1- 1  )/■*.(  1  )+(J2-l  >*(<  2-U/‘i*:(  2)  ♦...))>  ,  SUMMED  FO1  ALL 

C  J1  *  K 1  BETWEEN  l  AN 0  N  (l>,  J2,  K2  BETWEEN  1  AND  *1M(2>,  ETC. 

C  THERE  is  NO  LI  FIT  rr-  THE.  number  of  subscripts,  data  is  a 

c  multioimensi :nal  complex  array  whose  real  and  IMAGINARY 

C  FARTS  At  ADJACENT  IN  > T c  1 A 5 E *  SUCH  AS  FORTRAN  IV  PLACES  THEM. 

C  IF  ALL  IMAGINARY  PA?  T3  ARE  ZER?  (DATA  ARE  DISGUISED  FEAL),  SET 

C  I  FORM  TO  ZERO  TO  CUT  THE  RUNNING  TIME  BY  UP  TO  FORTY  PERCENT. 

C  OTHERWISE*  I  FORM  =  ♦!.  THE  LENGTHS  OF  ALL  DIMENSIONS  ARE 

C  STORED  IN  An  AY  M N *  OF  LENGTH  NDIM.  THEY  MAY  RE  ANY  POSITIVE 

C  INTEGERS*  THJ  THE  P9CGRAM  RUNS  FASTER  ON  COMPOSITE  INTEGERS*  ANO 

C  ESPECIALLY  FAST  ON  NUMBERS  °ICH  IN  FACTORS  OF  TWO.  ISIGN  IS  *1 

C  0-  -1.  IF  A  -1  TRANSFORM  IS  FOLLOWED  BY  A  +1  ONE*  (Or  A  *1 

C  HY  A  -1)  THE  ORIGINAL  DATA  ’EA^EA0,  MULTIPLIED  BY  NTOT  (sNNCl)* 

C  N" (2)*...).  TRANSFORM  VALUES  A 5  E  ALWAYS  COMPLEX,  AND  ARE  PETURNED 

C  IN  ARRAY  DATA*  REPLACING  THE  INPUT.  IN  ADDI r ION »  IF  ALL 

C  01  MENS  10  0  3  A:  E  NOT  POWERS  0-  TWO*  ARRAY  WORK  MUST  BE  SUPPLIED* 

C  COMPLEX  ?F  LENGTH  EQUAL  TO  THE  LARGEST  NON  2**K  DIMENSION. 

C  OTHERWISE*  REPLACE  WORK  BY  ZERO  IN  THE  CALLING  SEQUENCF. 

C  NORMAL  FORTRAN  DATA  ORDE'I'iG  IS  EXPECTEO,  FI  0  ST  SUBSCRIPT  VARYING 

C  FASTEST.  ALL  SUBSCRIPTS  BEGIN  A'  ONE • 

C 

C  TUNNING  TIME  IS  MUCH  SHORTER  THAN  tHE  NAIVE  NTCT**2*  BEING 

C  GIVEN  BY  THE  FOLLOWING  FORM JL A.  DECOMPOSE  NTOT  INTO 

C  2  *  *K2  «  3**K3  •  5  *  *  K  E  *  ....  LET  3UM2  =  2*K2,  SD.MF  r  3*K3  ♦  5*KG 

C  *  ...  AND  NF  =  K3  ♦  KB  ♦  ....  THE  •  T  T  *»E  TAKEN  BY  A  MUL*  I - 

C  DIMENSIONAL  'PANSFCFM  ON  THESE  NTOT  DATA  IS  T  =  T#  ♦  NTOT*CT!> 

C  T2*SUM2M  3*3U"F*T4*f  F)  .  ?N  THE  CDC  3300  (FLOATING  POINT  ADO  rlME 

C  OF  SIX  MICROSECONDS) *  T  =  3303  ♦  NTC  r* ( 5 3  9*4  3*$UM 2*GR *3  J  MF  ♦ 

C  52C*!.F)  M I C-R CSECJNDS  CN  COMPLEX  DATA.  IN  AOOITrnfi,  THE 

C  ACCURACY  IS  GREATLY  IMPROVED.  AS  THE  RMS  PEL AT  I VE  ERROOT  99?99?9’ 

C  BOUNDEO  HY  .3  ♦  2  * •  ( -B  I  *  SUM (  F  A C  T  0  R  (  J I  »  *  1  .r>  )  »  WHERE  B  1 3  THE  NUMBER 

C  OF  BITS  Ifl  I  HE  FLOATING  POINT  FRACTION  ANO  FACTOR(J)  AaE  rHE 

C  PRIME  FACTORS  OF  NTOT. 

C 

C  PROGRAM  BY  NCR  MAN  BPFNNE®  FROM  THE  BASIC  PROGRAM  BY  CHARLF.' 

C  PADEP.  -AL^H  ALTER  SUGGESTED  r HE  IDEA  FO®  THE  DIGIT  REVERSAL. 

C  MIT  LINCOLN  LABORATORY*  AUGUST  1967.  THIS  IS  THE  FASTEST  AND  MOS" 

C  VERSATILE  VERSION  OF  THE  FFT  KNOWN  TO  THE  AUTHOR.  SHORTER  P^O- 

C  GRAMS  FOUPI  AND  F0U»2  RESTRICT  DIMENSION  LENGTHS  TO  POWE°S  OF  TWO. 

C  SEE —  IF EE  A UP  ID  TRANSACTIONS  (JUNE  1967),  SPECIAL  ISSUE  ON  FFT. 

C 

C  T HE  DISCRETE  FGURIEP  TRANSFORM  PLACES  THREE  RESTRICTIONS  UPON  THE 

C  DATA. 

C  1.  THF  NUMBF2  OF  I'UUT  OATA  AND  The  NUMBER  DF  TRANSFORM  values 

C  MUST  BE  THE  AME. 

C  2.  BOTH  THE  INPUT  OATA  AND  THE  TRANSFORM  VALUES  MUST  REPRESENT 

C  EQUI  SPACE  0  POINTS  IN  THEIR  RES°ECTlVE  DOMAINS  OF  Tl*E  ANO 

C  FREQUENCY.  CALLING  THESE  SPACINGS  DELTAT  ANO  OELTAF,  IT  MUST  BE 

C  TRUE  THAT  DELTAF  =  2*PT  /  (  \  N  <  I  )  *  D  E  L  T  AT).  OF  COURSE,  DELTAT  NEED  NCT 

C  BE  THE  SAME  FOR  EVERY  DIMENSION. 
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C  3.  CONCEPTUALLY  AT  LEAST,  THE  INPUT  DATA  A\’D  THE  TRANSFORM  OUTPUT 

C  REPRESENT  SINGLE  CYCLES  OF  PERIODIC  FUNCTIONS. 

C 

C  EXAMPLE  1.  "HPEE-DIMENSIONAL  FORWARD  FCURIEP  TRANSFORM  "F  A 

C  COMPLEX  ARRAY  DIMENSIONED  32  BY  25  BY  13  IN  FORTRAN  IV. 

C  01  ME  .%'S  ION  DA’AC32,25»13)»U03KC5J),NN(3) 

C  COMPLEX  OATA 

C  OA*  A  \N/ 32 , 25 ,13/ 

C  DO  1  1=1,32 

C  O'  1  J=1 ,25 

C  OC  1  K=l,13 

C  1  OAT  A ( I  ,  J , K  )=CCM3LEX  VALUE 
C  CALL  FOUR  T  (OAT  A  »Ntl»  3  »-l  *  1  ,  WPP  K> 

C 

C  EXAMPLE  2.  VME-OIHENSICKAL  F3RW4RO  TRANSFORM  OF  A  PEAL  ARRAY  OF 

C  LENGTH  64  IN  FORTRAN  It. 

C  OX  PE’. SIGN  DA  A  C  2  »  64  > 

C  DC  2  [=1.64 

C  0ATAC1 ,r >=*EAL  PART 

C  2  DAT  AC2.I )=C- 

C  CALL  FOUpT (DATA, 64,1 ,-l ,G»0 ) 

^  t  •  • 

DIMENSION  DAT  A  C 1 ) *NNC 1 > • I F ACT C 32  I ,WORK« 1 » 

CDC  6600  ZM  TIALI ZATICN 
WRirr<6,'7oac ) 

WR  =  0. 

WI=0. 

WSTPK=0. 

USTP 1=0. 

rW0PT.  =  6.2R31.'53Q7 
IF (NOIM-l  >>20,1,1 
•TO' =2 

DC  2  1 01  M=1 » ‘;OI v  4 

IFCNNC  10  !M)  )‘<2C  *  >20  »2 
NT OT  =NT0  V  +NN  < I  01 M) 

MAIN  LOOP  FOP  EACH  D I  MEN* I  ON 

*  P 1  =2 

00  01(J  I  D I M= i *  *  01 M 
r.rNNCIOINI 
tip 2=f  PI* 

IF("  -17920, VUO  *5 
FAC'  JR  N 

M  - 

NTWO=HPt 
F  =  l 

i  0 1 V  =  2 

10  I QUOT=M/ I OIV 
Ii'EM=M-IOIV*  IQUOT 
iFCIOUOT-IDI V)30*ll ,11 

11  IF  C I  EM120, 12,20 

12  NTUG'-NTWC  +  NTMO 
M=I QUO  T 

GO  TC  10 
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7  a 

30 


31 
3  2 


AO 

50 

51 

EC 

J 

C 

c 

c 

70 


71 

72 

73 

74 


e  o 


c 

c 

c 

c 

lot 
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idiv-3 

rouc/sM/io'z*-1 

HEM=M-IOIV*  IQUO 

IF( I OUOT- IOI V > bC  »  31  *3  1 

IFC-  EM)  4C*32*40 

IFACT< IF1=I01 V 

IF=IF*1 

m= r  quo  r 

GC  rC  30 

ID!V=IQIV+2 

GC  'C  30 

IKI  EM)GO»bl*GO 
riTUO=NTgn«.f«TWO 

GO  tc  70 

:fac?(if)-w 

~EPA  3 A TE  FOVD  CASES — 

1.  COMPLEX  TRANSFORM  ?3  REA.  TRANSFORM  FOP  THE  4^H»  5TH,ETC. 
DIMENSIONS. 

2.  REAL  .TRANSFORM  F0C  THE  2ND  O3  3RD  DIMENSION,  ME*  H  'D-- 
TRAMSFORM  HALF  THE  DATA*  SUPPLYING  THE  OTHER  HALF  BY  CON¬ 
JUGATE  SYMMETPY. 

JUG ATC  SYMMETRY. 

3.  REAL  TRANSFORM  FCR  THE  15T  DIMENSION*  N  CDO.  ME~H3D — 
TRANSFORM  HALF  THE  DA  r  n  AT  EACH  S^AGE*  SUPPLYING  THE  0‘HEJ 
HALF  BY  CONJUGATE  SYMMETRY. 

4.  REAL  T  °  AN3FQRM  FC*  THE  1ST  DIMENSION*  N  EVEN.  HE'HDD— 
TRANSFORM  A  COMPLEX  ARPAY  OF  LEMSTH  N/2  WHOSE  REAL  PAR^S 
ARE  THE  EVEN  NUMREPED  REAL  VALUES  AND  WHOSE  IMAGINARY  r>APTS 
A^E  THE  CDO  NUMBERED  REAL  VALUES.  SEPARATE  AND  SUPPLY 

THE  SECOND  HALF  BY  CONJUGATE  SYMMETRY. 

V0N2=NP1 • CNP2/NTUO  >  4 

ICA  C=1 

IFCIDIV-4>71*SC* ?0 
IFCIFO.TMI  72*  72  *00 
TCA  F=2 

tF( IDIM-l >75,73*-0 
ICA  E=3 

IF<rt7WO-\Pl)«C*00.74 
[  CA  E=4 
f,TUC  =  NYWC/2 

r:=K/2 

NP2=- P2/2 
••TOT=NTO'  /2 
:=3 

DC  00  J=2»NTCT 

OAT  A  <  J  ) =DA  T  A  €  I > 

I  =  I  >2 
i  1  PMG-NP  1 

:F(ICASE-2>100  ,?5,IC0 
I1R\G=NP0*  ( 1  ♦  NPRF.  V/2  > 

SHUFFLE  ON  THE  FACTOR  3  GF  TWO  IN  N ■  AS  THE  SHUFFLING 

CAN  BE  Oi.' NE  IJY  SIMPLE  INTERCHANGE*  NO  WCPKrMG  ARRAY  IS  NEEOED 

IECNTWO-EP1)60  0*600*11-0 
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FTH  4  •  c  ♦  1  5  4 


10 


113 


12" 


12' 

13C 

14'? 

14" 


15r 

C 

C 

C 

C 

c 

c 


tic 

32  C 


33C 


340 
350 
35  P 

3  70 


3:-.C 

3?r 

40  0 


405 


410 


'iP2HF  =  NP2/2 

J-l 

DC  150  I  2  =  1  •  *  P  2  t ?  0 5’  2 
IF(J-r2>120.1  3C  ,130 
IlMAX=I?*N0’2-2 
00  125  :  1  =  :  2.  UMAX  ,2 
0-?  123  I  3-11  ,f.nr  ,NC! 

J3=J>I3-  2 
TFMFP=DA‘  AC  »> 

7EMPi=DA*  AC  !  *  1 ) 

OATA  < I  3 ) =  OA  A ( J3 1 
0ATA(!3>l)=0Ar  A<  J  3*  1 ) 

DAT  A  <  J3 )  =  TEMr 
DAr  A ( J3+1 >=TCM?I 
M  =  f;f’2HF 

!F( J-M)150»150  ,145 
j=j-y 

IFCM-.N0r!2H5?  ,143,140 
J  =  J»v 

MAIM  LOOP  FO;-.  FACTORS  OF  TWO-  PERFORM  FCU°  I E9  TR  ANSFOD,C  CF 
LENGTH  FOUR,  UITH  0*'E  OF  LE'.'GM  TWO  IF  NEEDEO.  THE  TUIOOLE  FAC'*'R 
W=EXP(ISIGN*2*FI*SQRTC-1>*,M/<4*HMAX>).  CHECK  FOR  U=  ISI  GN*3Q*T  (-1  ) 
A’JO  REPEAT  FCR  U  =  I  S I GN*  SOR  T  C -l  )  *  CO  H  JUG  ATE  <U  I  . 

*JON?5=NON2«-r!  N? 

I  PAN  =NTWC/MPl 
[ F ( I P A ■  -2  >350 , 333 ,3 20 
I PAR  =  1  PA  /4 
GO  '0  31 C 

DO  3  40  11=1,11  MG, 2 

00  340  J3  =  I1  *NON2  ,-NFl  * 

DC  340  K  l  =»l 3  ,  M T 0 T  •  N C M?  T 
K2  =  K1+N.  N2 
TEMP°=DA  A(K?> 

TEMP ! =OA  A ( K 2 ♦ l ) 

DAfA(K2)=DAT  A<Kl 1-TEVPi 
DATA  (K2  *1 1=DAtA(KI*1J-TEmpI 
OATA(Kl  )=DATA(K1  )«-TE”P5 
DATA(Kl*i »=DA"A( Kl+1 ) ♦TEM3! 

MMAx=N0n2 

IF (MEAX- ’ F2HF ) 370 , 6L0 ,525 
LMAX -MAXO  <NCM2  T  »M?1AX/2  ) 

IF CMMAX-N0N2)405, 403,355 

THET  A  =  -T  WCPI *FL3  A  T C  PN21/FL2AT (4*MMAX) 

IFCKIGNMOC  ,390 ,3?C 

rHETA=-THETA 

UR  =C  JS<  T  HE T  A  ) 

WI=3: '(THETA) 

U3TPF  =-2.*WI »W* 

US  TP  I -2«  *  UR  *  UI 

DC  5  70  L  =  NO:>2,LMAX,?  3N2r 

M=l 

I F <  M‘-AX-'.CN2>4  20 ,420,410 
W2R=UR«Ur  -Wt  *UI 
U2I-2.*WP  *UI 
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W3R=W29*  w«-w:i  »Jl 
M3  I  =  M2 17  *  W I  ♦  U2  I  • 

42'.  02  530  I  1 -1  ♦  ,  1  \fi.2 

00  530  J3  =  I1  .fiC^2,r«  1 
KMI \  -  J3*  I  PA- 

rF(MMAX-.*;0fi?)45:  »430,44n 
430  KMIV=J3 
44  0  K0IF  =  I PA  '  *M^AX 

4^C  KS’fP=4*K0IF 

00  620  K 1  =  X ° I \ ♦  ‘  TO’’  » K /■  \EP 
K2-K1 *K0:F 
K3  =K2  *K0 1 F 
K4=K3*K0  IF 

!  F  C  O'n‘2  )  4  62  *  46  C  »4:<  0 

460  01R=DArA(Kl>+DAr A(K2I 

U1  I=DATA(^1«-1  >  *0AT  ACK2M  * 

U2R  =DA7  A<K3  )-»0AT  ACK4) 

U2  I  =D A  T A  (  K3 ♦  1  ) *0 A T A <K 4*  1  > 

U3R=0ATACK1 l-OA’ ACK2» 

U3r-0ATACKl>U-0ArACK2*l) 

I  F  C  I  s  I  GY)  4  70  »  4  7 5  »  4  7 5 
4  70  U4Pr{jATA(K3*,l  )-DArA(K4+i) 

U4I=0ATACK4I-DA- ACK3) 

r.o  ”0  51  c 

475  U4R-0ATA<K4*,1  )  —  D  A  T  A  (  K  3  + 1  ) 

U41=0ATA(K3>-DATA(K4) 

GO  “C  51'J 

4  '  T2R  =  W2R*DA7A<K2>  -W2I  *OATACK2*l  ) 

?2I~'<*2R*0ATA(K2*l)*-W2l*0A7A(K2) 
r3R  =  US  *UArA(K3)-UI  *0ATA<K3-*>1  > 
r3I =UP*OATA(K3*l >»UI*0A* A1K3) 

T49-M3R*OATACK4)--M3I  »OATACK*^l  > 

MI=W3°.*0A:A<K4«-l)*U3I*DArA(K4>  i 

UlR  =  nATA(Kl)  2° 

01  I=0ATA  (Kl«-1  )*■  21 
U2R=T3P*r  4R 
U2 1  =  T  3 1 ♦ *  4  I 
U3R  =  0AT A <  K 1 1 2  = 

U3t-0A7A<K1*,1)-"2I 
I F  ( I  ■  I  Gf.  )  49C  •  5C0  1 53  C 
4?r  U4R=r3I-'4I 

U4I=  T4R-  39 
GO  '0  510 
500  U4R  =  r  4  I  —  r 31 
U4I  =  T3R-  4s7 

51  C  UATA(Kl)  =UU  «-U2’ 

OATA(KlM  )  =U  l  I*U2I 
OATA(K2)=U3»->U4R 
OATA«K2*l »=U3l*U4I 
OAT  A<  K3  >  =U1 2  -U2R 
DATA! K3*  l )=U1I-J2I 
OATA<K4)=U3R-U4R 
52'  UATA<K4M)=U3I-U4I 
KMIU  =  4*<KMP  -  J3 1  ♦  J3 
KOIF=K3TfcP 
KOIF=K37  F.P 

rFCKOIF-f,P2>450«530  *53C 


uiine  Fom 
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FT*|  4  •  V  ♦  5  S  4 


[l 


CONTINUE 

McM^AX-M 

IF  T  ',IGN)54C  »rj-iD  t5fiC 

TEMPP=WR 
UR  =-WI 
VII  =-  TEMP  • 

GO  '0  560 
~EMPn=UP 
V|R  =  WI 
HI  =T  EMP 

rF?M-LMAX>565, 565*410 
rEPPP=WP 

UP  =  W.~*M5TPP-UI  •U5TPI*WP 

ui =wr*usrPR*:EMPR  *wstpi«-wi 
IPAP -3-1 P Ac 
V  ,M  A  X  =  M  M  A  X  ♦  P  ‘  ’  A  X 

no  ~  )  .v  o 

MAIN  LOO °  Fr~  FACTORS  NOT  EQUAL  TO  TWO.  APPLY  THE  TWIDDLE  FACT'"R 
W=EXrCI 31&N*2*PI  *  SQF  '  (-1  )*(  J2-1  )  *  C  J1-J2)/  (f'P2*IFPl)  )  «  r  HEN 
PERFORM  A  FOURIER  TRANSFORM  OF  LENGTH  IFACTCF),  MAKING  "SE  OF 
CONJUGATE  SYMMETRIES. 


:FC'itU0-NP2  >605.70  0  .70  0 
IFP1 =N0N2 
!F  =  1 

NPlHFsHPl/2 

!FP2=IFP1/IFACTCIF) 

J1  R*1G-N=  2 

;FCICAoE-3)612.61l,*:i2 
JlRI,;G=CNP2  +  IFPl)/2 
J2  S  TP  =  NP2 / IFAC ’ C IF) 

J13G2=< J2SrP+IFP2)/2 
J2MIN=l*IF-2 
I F «  I  FPl-'.P2)f  15,640 ,640 
O''  635  J2  =  J2  WI\‘*  IFP1  ,  IFF  ' 

THET A=-TUQPI «FL)AT<J2-1 l/FLOA” <\!=>2> 
r  F  C  r - IG\)&23, 623,620 
THETA=-THETA 
5IN7H=3ir(THEr A/2. ) 

HSTP  j  =  -2.*SIMH*SINth 

wstp:=si*  cthe'A) 

WR=H5TPS 
HI -US TPI 
Ji  HIN=  J2*  IF-'  l 

D1'  635  Jl=JlMiri,JlPriG,IFPl 
1 1  MAX  =  Jl  *11  ’  f.G-2 
O'-'  630  !1=J1  .UMAX, 2 
DC  630  l  3  =  1 1  ,'1TD  ■'  ,NF2 
J3MAX=I3*IFP2-N?1 
03  63C  J3=I3, J3MAX.NP1 
’EMPR  =OA  A < J3 ) 

OArACJ3)=OArA(J3) *UP-OATA( J3*l >*Hl 
DATA<J3»1)  =  TEMPR*WI*DATA(JW1>*J’ 

!EwP«=Ws 

WR=WT»H3TPR-HI •W5TOI+WT 
HI =TEMPR*U$TPI ♦  W I *U FT  PR ♦HI 


urr*E  fi:ukt 


nn* 


pmdvf 


FTM 


V* 


(. AC-  "HETAS-7V0PI/FLCATC  IFAC  (IF>> 

: f c i  rr.:j»b5o  *1,45 .6*: 

6*  THETA=-THE’A 

652  SZNTH=S  :■;<  THE'  A/2.  > 

WJTPh  =-2  .  *SI  ■  TH*  ol  r.  H 
WSTPIsSlNCTHt ' A) 

k3Te;-=2*-\/ifac  1  ;f> 

KP.ANG=Kj  ’  EP*  f  IFAC"  C  IF)/2>»1 
O'  6  -3  I  1  =  1  ,  „  1-VG.2 

00  6  ?  I3  =  n  ,fjr 0 

00  6  -0  K  MIN= l  »  K3  Af!G » KS '  Ep 
aiHAX  =  I3*Jl3AG-IFPl 
0  :  600  J1  =  I3 , J1MAX,  :fpi 
J3PAV=  J1»IFP2-’;£,1 
00  630  J3=J1  *  J3MAX  »*;Pl 
J2f'AX  =  J3*IFri-lFP2 

K  =  KMI*!^C  J3-J1«-CJ1-I3>/:FACTC  IF»  )/N3lHF 
.  I F  C KMI 1 > 655* 655  *665 
650  ^um=0. 

SU«I=0. 

00  660  J2=J3,J2MAX,:FP2 
SU^P  =  SUMR+QA  T  A(  J2  ) 

66 C  SUMI =  SUM I ♦DA  A<J2+1) 

U0PK(K)=5UMF 
WORKtK+1 »=3LMI 
DO  TO  630 

6^-5  KCO'J  J=K*2  •  <*:-KPI M  *  1 ) 

,J2=J2MAX 
SUMP=0A  A ( J 2  > 

3UVI =0AT A< J2*l ) 

CLO. 3=0. 

old::=c. 

J2=J2-IF-2  *■ 

67G  TEMP3  =  SUMR 

TEiu!w;  =  $U^,I 

SUM  >  =  TUCUR*  .UfM-0L0SP+0ATAC  J2  ) 

SUMI -  TWO UR*  SUM! -OLOS I *DA ’ A ( J2 ♦ l > 

OLDCP=TEMPP 
rL03 1  =  TE  MP I 
J2  =J2-iFr'  2 

IF( J2-J3 )675  #6  75,6  70 
67b  T  tMP°  =U3  * SU7*S  -OLDSP+DA'  A  (  J2  ) 

teppi=u[  *slm: 

W0RK<K)=7EMP=-t£MPI 

WC3KCKC0NJ)  =TEMP!?>TFMPi 

rEMP°  =  M  •  •SU,,:-CLO'$I»DATA<  J2*l  > 

TCMPI  =  UI  •SUM,- 
WORKCK+l  I  =Tf.vpR«>TEMP: 

WOP K  C  KCCf'J^l  )  =  TEMFP- TEMPI 
60  CONTINUE 

IF4K “l '1-1)605  *63 5  *62  6 
6F5  WR=WSTP°^1. 

WI=WSTPI 
DO  T  *  6?G 
6»6  fEPPTrWR 

Wri  =W::  •  WSTPR  -  WI  *WS  TP  I  ♦  V|3 
WI STEM®3 • WST  PI *WI *W$TP**Vl 


E  F  Uu 
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OP”  =  l  Pfipvr 


F~’>!  4  .  '  «■  r»  6 4 


Er-  C  TUOU- =WP  *W4 

l  F  1 1 C  A  >E  -  3  ) •  2  *  0  ;  1  *  •'  n  2 
6-1  IF  (  I  FPl-l ;p'2  )  t':»  0?  2  •  n?r 

€•=2  K  =  l 

I  2MA*=I3  ♦i'  P2  -  .  '1 
DO  6-3  I2=I3tr?VAX»VPl 
DAT  A(I2»  =WQ'  K(KI 
DA  T A  < 1 2  * l »=W ’ ~ K I K * 1 ) 

673  K-K+2 

G  3  *  2  6  5  v- 
C 

C  CCMFLET  E  A  PEAL  TP  A/iOF C“  M  I  N  THE  ].c;T  olMENO ION*  N  TOO*  GY  CCN 

C  JUGAtE  SY.MPF.  TRIES  AT  EACH  StAGE. 

r. 

6:  2  J3f'AX=I3*IFP2-NPl 

02  6  J7  J3=I3tJ3MAX,f.Pl 
J2MAX  =  J3 ♦EP2- J2  3  TP 
PC  tn7  J2=J5 , J2MAX, J23rP 
JIMAX=J2*J1 - G2-IFF2 
JlC'i  J=J3*J2,!Av+J2STP-J2 
0"  *-'7  J1=J2,J1MAX  ,  IFP2 
K=  1  ♦  Jl  —  l*  3 
I) A  T  A  ( J1 )  =  WOP  K  C  K) 

OAT  A ( J1 ♦ 1 )c«nPKC K+l  I 
IFIJI~J2I6?7,697,6C:6 
6t6  I)ATACJ1CNJ)  =  W0FK(K» 

DATA! J1CEJ+1  l=-WORK(K+l) 

6  ■*  7  J1  C*;J-J1CMJ-IFF2 
6S0  CONTINUE 

:f=: f*i 

IFP1=IFF2 

IFCIFP1-NP1  >  700,700*6 10 

c 

C  COMPLETE  A  PEAL  T?Af!SFOcM 

C  JUGA  TE  SYMMETRIES. 

C 

70  C  GO  'C  <  9  C  C  »  l*  ‘J  0  »  ?  0  0  *  7  0 1  >  »  I C  A  S  E 
721  JHALF  =  - 

N  =  N>- 

THET  A=-TW0PI  /FLOAT  CM 
IF<  I  IGT:  ) 70 3*70 2*702 
7C2  THETA=-THETA 

703  -?INTH  =  SIfiCTHEr  A/2.  > 

WSTPF--2.*$Ii-i7H*SIN*  H 
WSTPI=GIM<thpta> 

UR=WSTP2*1. 

wr  =w''tp: 

I  Ml;  =3 

JMIfi  =2*  N  HALF-1 
GO  T  0  720 
710  J=JMIE 

IK  720  I=IMIf.  .fT3T*f  P2 
SUFR - < DAT A ( I > ♦ DA  A(J))/7. 

3 :UMI = ( OA T A< I ♦ 1 ) »OAT A ( J* 1 ) ) / ? • 
o:FF-<DATAC  >-OA'A(J)»/2. 

01  FI =<OATA C ♦11-OAT  AC J*1 >>/’. 

•  E  MP F  =  U°.  *  3l)M  l  ♦  WI  *  0 1  F° 


4 
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2  O  r  -  ^  p  m  [)  M  c 


F™  4.F*56  4 


10 


enpisw;  .  .3 u  1 :  -  r  *o  i  f-* 

DA f  AC  I  1  =3U"  •  *■  TEMP 
DATA  (1*1  )rO:FI«-  EMP; 

0 A T A  <  J )  =  >U.**  -  T  E V P  - 

da r  a  ( j ♦i  )=-d:f:*-*emf: 

J  =  d*  P 2 

rMr7-=iHi.\*2 
JHIf.-Jvp  -2 
tempp=vi> 

W4  =Wf;*W3TP9.-Wi  *W2TP:-*-W9  „ 

W!  =  rt  MPIx  *W3rnI+W[  *WJTP!'*L'I 
!F<  JMI\  >710,730*740 

Opt!  IGD731 ,740,740 
DO  735  ,r;T0T,*.»2 

OATA<I*l >=-UATA<  t ♦ 1 > 

{ P2=?.P 2+' P2 
.TOT =  MTQT ♦m  r  0  ’ 

J  =  NKT+1 
JMAXr'UC' /2*l 
IMIf;=IMAX-2»  .HALF 
I  =  I  M I N 
GO  T"  755 
OATA( J>=OA~A (I > 

DATACJ*1 1=-DATA< 1*1 > 
i=:*2 
J=J-2 

IFC I-!MAX>75C , 7bC *  760 
OATACJ)=OAT  A<IH!*)-DAT  A  (  I  > 

DA’’ A  CJ*1 )  =0  . 

TF(I-J»77C,7  C,7t>0 
DATA CJ)=DA'A C I > 

OAT  A  C  J+l >  =DA*ACI  «-l > 

!=!-?  4 

J-J-2 

:  F  C  I-IMr  >77',  773,765 

OATACJ  >  =  OATA  (I  MI  \  )-*DATAC  IMIV*l  > 

DAT  A  C  J*1  >  -0  . 

!  M.  A  X  =  I M  X  *■! 

GO  '0  745 

QATACl>=OATACl>*DATAC2> 

DAT  A  C2  )  =  G  • 

GO  '  0  93  ,7 

COMPLETE  A  teal  TR  AMSFOPM  FO3  THE  2DD  Ca  3PO  DIMENSION  H*' 
CONJUGATE  SY^MCT?  IE  .  . 

: F< 1 1 90G-LP1 )  +  05.90C  ,700 
DO  ”63  I  3  =  1,*  TCT,UP2 
I2MAX  =  I3*\'P2-HF1 
OJ  *60  12  =  13*  1 2MAX  , *>F  1 
=  G 

IMAX=I2*LPl-2 
UMAX  =2*1  3  *NP  1  - 1 M  I  •'> 
rF(I?-:3>T2C,520,810 
JMAX  =  JMA  X  *riP  2 

:F<:niv-2>.r-j(,-r, o,s33 

J  =  JM AX*\P  0 
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.;dT  =  1  P'-'Of-'P 


FT*l  4.«*,r>^4 


cub-  our  tnl  gal*.:  :  ( i  a*  i  y  iVad 

C  THI  :  RGUTT'.t:  CALCULATE  a  GAUSSIAN  OiSTSIHUTEO  pamu«  m  va?i aile 

C  VAL  »  «ITH  *  A  ‘  -  •:  •  Ar  0  S'A'*nA40  nEVIArIDN=l. 

c 

C  IA  IS  ir:  it*  Ac! /ED  BEF  Cs  F  FIPST  CALL  TO  ANY  COD  INTEGEC  LESS  THEN 

c  la  oiGt's  i\  le::g  h. 

C  IY  IS  GEvr-A'EU  AND  SHOULD  BE  USED  FO*  !A  THE  MEXT  CALL  0 

c  thi:  1  o  u  t  i  Cm 

VAL=n  . 

o:  i  i=i.i2 

X=f  A'.FCDUM) 

I A  =  I  Y 

VAL-VAL+H 
1  CONTINUE 

V AL=VAL-o. 

BETfPN 
Ef  I) 


•:i  'JTI  f.E  !!  vrJ  • 


74/7*  1=T  =  1  PVO'^ 


FTN  4. *♦56 4 


0 


IOC' 

a 


i 


1C 

15 


20 


25 

I  0» 


I 


30 

35 

3 


40 

45 

46 


50 

55 


3 OUT  IfiE  r  NVF.3  TC  A»N*n,IE4  ) 
IMPLICIT  PEAL  (  A  -H  ,  0  -  /  ) 

DIMENSION  Ml)iB(l) 

PEAL  LC12r ■)•’<(  126) 

NS  0  =N*M 

DO  1000  1=1, N'Q 
HCl  >  =  AC  I 
n=i  .0 

LK--N 

DC  SO  K  =  1  , 

NK  =*.«♦' 

L<K>=K 
M(K)=K 
KK  =  K*K 
8I0A=ACKK) 

DO  20  d  =  K, •» 

IZ=.N*(d-i> 

DO  23  I=K.'! 

u-iz^r 

I  F<  A8S  (RIGA)  -Arl '  (A<  I J)  )  >  15,23,20 
81  GA=At(  Id ) 

L(K)=I 

MCK)=d 

CONTINUE 

d=L(K> 

IF  (  d-K>  35,35,25 
KI=K-N 
DO  33  1=1, 

KI=KI*N 
H 3LD=-A(K: » 
dI=KI-K*d 
ACKI  )=A(dT> 

A«d!l=H :lo 
I  =  V  (  K  I 

IFU-K)  45,45,38 

dp=?  *u-n 

00  40  d  =  l ,' 
dK=  K*d 
dI=dP>d 
HOLD=-ACdK) 

A<dK)=A(dI) 

A  C  d I ) =H  LO 
IFCBIGA)  45,46,48 
0=r.O 
IE  =125 
Gr  TC  150 
OC  55  [=1, 

IFU-K)  50  ,55,50 
IK=.’  K* I 

auki  =  a«ik)/c-h:ga) 

CONTINUE 
DO  05  1=1, 

I  K  =  >'  K  ♦  I 

Id=I-’ 

DO  45  d=l* 

IFCd-K)  62,^5,62 
Kd=Id-I«-K 


l 


10/ 


6C 

62 
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IOC  2 


ac:ji=acik>*a(kj)>aci.)i 

CCNTrVJ.E 

KJ  =  K-  i 
DO  / 5  J=l. 

KJ=KJ«- 

IFCJ-K)  70.75,70 

ackj>=ackj»/b:ga 

COM  7 1  -*>*U t 
D=D*  BC  GA 
A(KK):1.0/fl  GA 
CONTINUE 
K  =  'i 

K=CK-1) 

IFCK)  150,150  .105 
I=LCK> 

IFC-K)  12?  *120  •  10,J 
JQ=\*CK-1 I 
J*=r  ■*  ( r -i ) 

D?  110  J=l,. 

JK-JQ*J 

H0LD=ACtJ«» 

JI=JP+J 
AC JK)=-AC JI » 

A ( J 1 1 =H  LD 
J:'MK) 

IFCJ-K)  100.102,125 
KI=K-  : 

DO  130  1=1, 

K I  I  ♦' 

HOLD=A(Ki) 

JI=KI-K+J 
ACK!»=-ACJ; ) 

AC Jf)=H  LD 
GO  Trj  i  Of 

do.  1002  i=i,n,q 

3AVE= AC [ ) 

A(  :  )=HC  k  » 

DC  I )  =  5AVE 
CONTINUE 
F.C'URr.: 


FT ?l  10, 


4 


'J  T I  f  F  f’L'LT 


n/i* 


:pr~ 1  p^n»- 


FTH  4. ‘>♦5?;^ 


10 


UUH  iCUTIf.E  rUL  r(A,H,L*M,'  «C  » 

3  EAL  A(L.")  E  >  ,C<L*  > 

on  300  i=i,r 

DO  200  J=l,l 
Ctl  ,j)  =  r. 

on  ion  imh->=i 

CCI  *J>  =  CCI,  J)*AM,  r  0tX»*8C  IMOF.X,  J> 

CONTINUE 

continue 

CC?;.*INUE 
RE  r  URN 
E’  D 


■J?t\E  CH?Lr 
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03T=1  P^r)M3 


FTN  4  •  R  »  5  6  4 


SUN?  OUT  I  ME  CHPLY(AtN) 

THIS  P. OUT  I U  fc'  DE  T  EP  Mi NE  S  TH~  LOWER  r  3  I  ANSULA'5  CHOLESKY  S JUARE- 
ROCi  OF  AN  Xf;  MATRIX. 

A  IS  THE  INPUT  MATRIX  AMO  A  15  THE  CHOLESKT  SQUARE-ROOT  MATRIX 
01  MEM  SI  ON  A  €  N  * '.!  ) 

OC  123  I=l» 

00  123  J=1  »"! 

IF(  AOS(A(I  ,J>  l.CT.l.E-'R)  G  0  '  n  l?<* 

CONTINUE 
00  125  ;=l.* 

O'1  125  J=l.- 

ACI»J>=0. 

RETURN 

A(1,1>=3Q~ * ( A( 1 «  1 )) 

OC  5  1  =  2  ,i< 

I  Ml  =1-1 

00  3  J=  lf  I'U 

J?1=J-1 

SUM=0. 

IFIJ.EO.l )  GO  ~0  3 
00  2  K=l»J*’l 
SUM  =SUM  + A ( I *K ) *  A ( J  *K ) 

A(I»J)  =  (ACI»v))-SUM)/A(JiJ) 

SUM-'.’  . 

DO  4  K=1.:m1 

sum=sum*ac: «k ) *  *2 

A  <  I  « I  l  =  SQRT(A(! ,11-SUM) 

DO  6  I -1 

:^i=:*i 

00  5  J=IFl  ,  . 

A<  I*.J>=C  . 

RETURN 
E>  0 


o  O 


UTIfE  FLTA  74/74  0=»T  =  1  pvnwp 
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'  UBR  Ufl’E  PL  T  A  C  t  I  MPL  «  A  •  B  •  M  r  »  A  ML'  3  ,  I  '« ,  I  ,  N  AME  ) 


C 

c 

c 

c 

c 

c 


INTEGER  I 

'  EAL  B(MIN)  »  A  (MM)  »T  I MPL (SIM) 

DIMENSION  NAME  <4=3 1 

THIS  SUBROUTINE  PERFORMS  THE  PLOTTING  CALLS  REQUIRED 
■  0  PLOT  T HE  FILTER  ESTIMATED  RMS  ERRORS  VS.THE  ACTUAL 

FRRC;-'  ' 


M2=NFPAMF  :*2 

CALL  SCALECMVPL.6..  2tl> 

H  (  N  2  ♦  1  )  =  -  •  1 

H<'i2+2)-i.2r> 

CALL  AXIS(0..0.»31HT:ME(SECI,-5,E.»0.  *  r  I N  P  L  CN  2*1  »  *  T I  MPL  C  N'’  ♦  ?  )  » 
CALL  A XI  S(G.  ,G.  »l  JHF.PPOR  « P IX ELS  >  »  1  3  1 4  .  *a  0  .  tRC  V2«- 1  >  ,R (*!?♦'') 

••  ) 

CALL  L  I?'iE  (T I  yPL *0 »N2  «i  »C  *?  I 
CALL  PLO  CO.tO.tJ) 

A(N2*l)  =  H(f|2*l) 

A(N2+2l  =  n(  l2»?  > 

CALL  LINC<  r  I  MPL  .  A  t'i  2»1  tO  *G  ) 

CALL  PLC'(-l..-l.,-3> 

CALL  PL3*  (R. »0.» 2) 

CALL  PLC  (M.  »2> 

CALL  PLO  <G. »6.»2> 

CALL  PLO  (0.'f:.f2) 

CALL  SVMn^LCl.OfS.Sta.l^t'.’AMECDfO.fSS) 

CALL  PLC  <G.»').»3> 

CALL  PLO  (lJ.*l.t-3l 


UTILE  FLTB 
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:ot=i  pv[)'° 


FT"  ♦ 


r 

c 

c 

c 

c 


c 

c 


c 


3C 

40 

c 

c 

c 

c 

c 


urn. •'UTIf.E  TH<  TIM  -  f  AfntC*,;rMl  ,\,F=»A*'E  ,  r»NAME» 

♦  KiM",PTA,PTritCTC.P  n> 


I  NT EGER  MK,:  .1*1  #»:F*  AMES*  :*<*,!*?«■»  tCCUT 

"EAL  TIM-'  (MM  >  *A(4  t'.F^A^F  •  )  *  BC  4  ,  NFK  AMES  I  «C  (  A  *  NF  -  AMF  ’  I 

f  F  AL  PTA(M’l)  *PTB€MM1>  »PTC<M«t  1  *P  0(f!IMl  I 

DIME-!.:  ICE  NA’EC4CI 

THIS  SUH,:UTI\F.  PLOTS  'HE  MEAN  E*a?F?,  (♦/-)C»;E  SIGMA 
USING  THF.  OA’A  FROM  THE  F.IL2T  ROUTINE.  THE  M AMES 
FOR  the  ARRAYS  WERE  DEVIOUSLY  -rC*EO  rN  AR°  AY  NAME. 

••2=NFRAML'>2 

COU'J  =1 


no  2  C  J=1  •  fJF PANES 
PTA(COUM)  =U(I  t  J> 

PTA<COUNTM)=A(I,J> 

P*H( J>=A(I , J) 

PTCC J>=B(I , Jl 

ptoc j) =ccr » ji 

CO  UN  T=CC ON >  *2 
CONTINUE 

CALL  oCALECP  T A,4.,N2«1) 

PTBCNFPAPES^l  >=PTA(f!2*l) 

P  TC  (  f.F  FAMES*  l  >  -P  7  A  C*!2*l  • 

PrO«NFPAMES*l >=PrACN2*l  I 
PTH<r:FPA"ES*2)=PTA(?.2*2l 
PTC(NFRAMES*2  I  =PT  AC\‘2>2  I 
PT0riFRAPE3*?>=PTA(\2*2l 
CALL  SCALE (T  T  MR*  6 • *NFRAPE>  * l  I 

CALL  AXIS(0.,'3.,rHTIME(SEC)*-9*S.,0.*rlM  -  U  FRAME"**!  • 

*  rIMK(NFP  APE  *.♦>?.  II 

CALL  AX!S(0.*C  •  »13HF?PC°(PI>(EL$>»13,4«,:?0«»PTA(N2*1  I ,P’ACN2*2) > 
CALL  Lr-JECTIV*  tPTB.NFRAVFS  ,1,0,0  > 

CALL  PLO  (G.,3.»S> 

CALL  L INE  (  TI  MR  *P TC , NFR  AME S  »  l  * 3  ,  '  ) 

CALL  PLO ' (0. ,0 . ,31 

CALL  LINE (TI MR  ,PTD * NFP AMES *1 *3 *1  I 

CALL  PLO  (-1 . 

CALL  PLO. (R.,0.,21 
CALL  PLOT (rt.,*.,2> 

CALL  PLO*  (  0 ••-.•* 2  ) 

CALL  PLOT (0. ,0 .,?) 
iF(K.GT.22)G'  TO  30 

CALL  SYMBOL U ,0 ,5.5  ,( .1  *  *N  A «F  <  <  >  ,  0  .  ,  4  0  > 

GO  rn  +Q 

CALL  S  YM  HOL  <  •  4  0  *  5  •  5  »  0  •  1  ‘S  *  N  A  *  E  (  <  >  *  0  •  *  *>  0  > 

CONTINUE 


MOVE  PENCIL  BACK  TO  OPIGIV 
CALL  P LO’(0.,C.,3» 


.ijTrrE;  plts 


7*/74  .'Pr  =  l  ?*o  v  = 


FTM 


FOSIr.IOf.  THC  Pfl’.CIL  FO*  THE!  *iE.XT  PLO " 
CALL  PLOT (13.al.t- 3* 


-E  T'Jrfi 
C  D 
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Computer  Software  (Trajectory  Model) 


This  appendix  contains  the  Fortran  source  code  for 
the  implementation  of  the  various  trajectories  and  the 
multiple  hot  spot  projection  model  detailed  in  Chapter 
2.  The  trajectories  and  hot  spot  locations  were 
generated  and  saved  on  file  for  use  in  the  computer 
simulation  given  in  Appendix  D.  The  program  was  written 
for  use  on  the  CDC  Fortran  IV  compiler. 


J'VAP  AJj  C 


7*/7A  p  •*()».«-> 


F  -  \  A. 


f-  os  am  ■■  a,j<-  nc  't°u:  ,hj  rc.<jr ,  ?  *o?  ? ,  7  *»Ee,z  ?ut?ut  »oequg  -  output,  t  ape  «?  > 
- E  A L  urc  >»1 >  »  SVHS2AC  lO  j  >  »2V  '12  1C  20 :  »  •  -‘m  3A(.?00I  •  SVHS3RC  ?C0  > 

.••  EAl  :  Vir  l  A  (  ••'  *  )  ,  $VM  .  1  RC  .7  I  0  ) 

EAL  PULL UP 
INTEGER  l.F'A'-E. 

•L-7EOEA  r~'i  ,  LF'L  A  >:F 

•iE'  :::  =  i  if  a  plot  f  tHf.  tensity  ce,,'°iqo  is  desi-eo 


X  3  »  Y  »  »A  iU  ?  i  A :  K  THE  IMI’IAL  I  ‘  F.  *  T  r  A  L  CUIRUIMATE* 

• c raooo: . 

YC  =170 oc . 

Z')zl;  OCC  . 

:ET  CO'ir  =  1  FOR  the  2G  PJLLJ®  AND  C7\r:  ‘iUATION  MANEUVER 

<  r^A  JECTOFY  .'•> 

C  )N  *-2 

iET  :pla*if:  -  1  fop  the  ~jt  of  plane  mavfuver 
(  7  R  A  JF C  T  0  R  Y  <*> 

PLA-  E=2 

u:=u*/3.i.» 

T  $T  A  -  T  AND  T  F I  Ti  .3ET  the  TTV?  FOR  a  ROLL  7*5  5tart  AND  EL  3 

tsta-'=i:. 

F I  -I  - 1  1 . 

NF*  A  ME ‘PIG'S 

IJI3V  13  PHF  fl  ESI  PED  DISTANCE  I  Y  THE  EBX  DIRECTION  FOP  HiKSPC 
ONE  IN  MFITEP'  * 

r>  I S  V  ^  2  A.'.o  5  A->E  THE  OFFSETS  FOR  HQT3P0T3  2  AND  3  IN  THE 
CRY  01  REC  T  I  T  *  IV  METER 

DIS'/=.l 
n: :vp2-. i 
u:svp3s-«i 
I  HE “C  . 

PULL'JP  SEr3  -HE  r  IMF  FOR  THE  PJLLUP  MANEUVF.p  TQ  STA»T 
CTPAJECT OKY  - » 

PULL UP =L  7 .0 

T  P  AT E  SET3  HE  DEGREE  Cc  THE  PUL'-UP  '’A'E'JVER 
2 -G  =  .  Civ  7,  *3-0=. 04  7.  A'  019-0  =  .!!  9  ■< 
r»A  F=0.olc)r 

00  07  [JR=l,f  FRAMES 


vOOT=  -jCO. 

TOOT-  -3C0. 

7  OCT  =  Q.7 

xpoo-  xu  ♦  x'nwiMC 
YPOj~  Yj+rO'!  r*7:ME 
/poor  zo ♦/O'  * ’ I  HE 
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OGi'AM  T:  AjfC 
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r?PT  =  l  PMfjV? 


F  r  M  4  ■  *  ♦  3  G  4 


10 J 


v7iH?=m*.E>fy‘ /?.o  ) 

if<t ;  ve.lt. pull'jpigc  no 

:FCCOrjT,r:E.I  »G0  ’0  ’1 
I  F<  fi-.  .LT  .  1  Or.  )  GH  Q  l 
IFCN-.GE.IOO  )<t)3T=-?03.5  1  3 
TF<NF*GE.1C  ~)Y03  T  =  2<*.0A? 

!F(NO.EO.l(H >  "  IMEA=':  . 

’  HE  XO  A f  0  Y  RE  LOU  A  IE  VALTO  -l?  A  2G  PULLU»  AT  T=3*‘>'EC 

«HE3  f  T-*E  TA'G  fj  CONTINUES  ft'  A  CONST  AWT  VELOCITY  AFTE’  'HAT  POTNT 


XG=In00.2 
•'C  =52.23=. 

XPQ3  =  X0*X0».‘f  *T  IVEA 
YPQS  =YO»YOOr*^IHEA 
' I  HE  A=Ti HEA+D* 

GO  T0  72 

71  CONTINUE 

7  F( OrL ANE • NE . 1 ) GO  TO  7  5 
xocTs-iaao  •*cos<.r°.ATE*cv:iHE-2.)  > 

yojr-ina-.  .*c*.  s < r3 ate*  t  vrr  me-?.  > >»3:n(t3ae*( /time-2. >  > 

/00r =-13 '0 .* ( SI 0<  TP  ATE* CV TI «P-2. ) >**?> 

XPOS=XO-2CO'  .-((IOC  /T3ATE)*SI'I(TRATE*(’I  ME- 2  •  )  )  ) 

YPC3  =  YO  +  (103  )/<2*Tf-.A;E)*<SI'ltr’ArE*CrIME-2,l  }*•?.)) 

ZP CT =20- 1 00  ? . * ( ( <  T I MF -2 . ) /2 . ) - C ( t . / C  4 . *  T  =  ATE ) )*SIN<2*T’A”E*(  I  ME-3 
if.)))) 

GO  T*.  31 C 
73  CONTINUE 

V DC r =  -10  00 .« COS CT FATE* <VTrYE-2.»  > 

YDOT  _  13  0  3.*  HI  NITRATE*  <Vn  ME-?.  >  > 

XPTi;  =  X  C  -  2  G  u  -  C  C  1  Of  /Tfi  ATE»  *SI0CT7.ATE*C  'I«E-2.»») 

YPOS-  YO  ♦  ((lJ0r/T'>ATE).(l.-CD3(T;(ATE*trIME-2.)»)) 

72  CONTINUE 

7P0G=  70  4 

31'  CONTINUE 

-HOr:=  XPl  3* »  "  ♦  7PC  3  *  * 

A,Gf  =  SHOP  ♦  Y  P  0  S  *  * 

T  C  1  *  l  >=  C-2POG*XOor*>XPO:?*230Tl/<RHC?*.Q200?> 

c  H0U  -  3Q'»T'CFH0’I 

UT(2»l>=(uH  -* YDOT-YFOS*! I  X 3 C $» X  DOT* ZP 33 *200 T ) /P HOR ) )  /<  3  AMGE 
♦  *.00002) 

'  ANGF  =  3QDH  AT-GE) 

VMAG  =  3Q3  T(XO  . T ** 2 ♦ YOOT * • 2* ? 30 T *  *  2 > 

Vf,AX  =  (  VMAG)  /<  ANGE*.C0CQ2) 

CALL  H3PPT<H:,lA,H31H,H:2A»H02BtH53AtHS3R»  TSTaPT,TFIN.T!  MEeCOOU 
tXPO:  ,YPC3#7‘>0.3*XD0T  ,  YOOT  »  230  T  , 01  S  V,  01  SVP  2tD!SVPJ* 

♦  ''|p»3VH3?A*SVH32B»SVH3  3A,~VH>3Be  WAGWHO*  ,»ANGE  >S VH3 1 A » c VH3 1 B > 

4P.I  T  EC  J  *  *  >  Nr'  iUT(IiI)  tUT  <  2  »  1  )  t  V  * A  X»  CO 3 W» R  AN GE  t  TI ME 
t:0  FOP '•ATt  I  4*GE14.5) 

UR I  TEC  if  *)H;iA.H.;iB»H0  2A.H3?B.H3  3A»H~3B 
fl  f 0PMA*(GEI4.E) 

y?ITF  C7» *  )XF  7G»YP05»7P03  »  X03  T  tYD3T*2D0T*TRA'E 
H3  FOPMAT  C7E14.5) 

•dP  T.  TE  CG»  '•  2  >  XPC3  t  YP03 ?  2P00  *K  3 OT  »YODT  *2  DOT  »  TP A  7E 
<i2  FOP  MAT  ( 1  X  »  7f  1  *  .5  ) 

:  ime=t:mf-*o 

s  ‘  CONTINUE 

C 
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',urif  E  PL  TO 


7*/74  C  3  7  - 1  PMOX3 


FTP  ♦  SSA 


n 


I 


jUHfU.UTI  ?.E  P'.TQ(  S  VH~?A*rVH^->  3t  SVHS3A,  SVHS 3R ♦ NFP A MES »  GVH  71  At  S‘!H31R> 

EAL  SVH72 A<*.30>  »3VHS2tt<?GC> 

-  EAL  3VH33AC 200 > *SVH33B(20C > 

’  EAL  SVH3  1 A  C  20  G>  »  S  VH31B C  2  3  2  )  ♦  4 3L  01  <  GO  0  )  *HC LD  (  60 0  » 

INTEGER  C7»‘.3 

•-KF  A ME 
‘  3=NFPAME  >  5 
C=1 

DC  i:  !  =  lt»«F:  AKE 

h ;ld<c r  »  =  :■ h:i aci  > 

H^LOCCT  *1) =  SVHG2A<  !  ) 

HCLDtC 7 ♦2)  =  3VH73AC  > 

H?L01CCT)=  ■  VH31BC T  ) 

HrLt)l(C7»l  ) -  SVH32B  ( I  ) 

H  H  01  (  C  T  +  2  >  -  SVH32R  C  I  > 

C7rC  O 

continue 

CALL  PLC  .  SCM  .  »!)•  > 

CALL  PL!'  ‘  (l«tl«»-3> 

CALL  SCALE CH LL 0» A • » '  3»t) 

CALL  SCALEtH  :.LDl  »A.  #  3*1» 

G VH3 2 A( N  +  l ) =HQL5 < ’  3*1 > 

5,VH32A(N«-2)  =  HOLO(‘;3«-2> 

SVHS'BPJM  )  =  HCLDlCf  3*l> 

:VHSS3Cf'  +  2>-HCL0l  C  *;3 ^2  > 

CALL  AX:?(0.,*5.,23HP'  CJECTION  I'l  THE  AL^HA  AXISt 
♦  -2  J  »A.  ,0  .  *SVM >2A(N»1  ) t CVH324<  V»2) > 

CALL  A*:  :  o.  ,0.t27HF' r.JEC*  IG'I  ON  THE  BETA  AXIS* 

»27f4.«‘-0.  »3VHS2H<f;*l  )  »  7  VHS  2  3  <  N  *-2  >> 

•'VH3  7A('i>l)  =  y/HS2A<^»l  )  4 

GVH7*B(U+1> = • VH‘>2B<N*l ) 

VHS  3  A  V  !♦  2  )  =  ^  VHS2  A  C  \+2  ) 

SVH3  3 B  ( '!  *-2  )=  i  VH:2B(N*2  ) 

S  VMS  1  A  (  N  ♦  1  I  =  HG  L0(  3+1  ) 

EVMSi  A('!»2)-H1L0(':3*2) 

'.VH3lB('l*l  )  -HOLOKNi  +  l  ) 
l\»HSiB<\’4?  >  =  HC  L01  3*2  > 

CALL  LT'if  C$VHS2AtSVH32BtV,l  *-1,3) 

CALL  PLC  (  0  .  i  0  « »  '5  ) 

CALL  L  ILL  C  SWH.V5A  *  SWHS3B  » »1  »-l  ,2) 

.CALL  PLS  ' <C. t0.«5) 

CALL  LI\t  CSVMnAtSVHSIH,*  ,l,-i  ,*> 

call  plo '  c-i . »-i . j 
CALL  PL3 *<6.t1.«2> 

CALL  PLC  CG.»6.,?> 

CALL  PLS  CO.  *S>.»2> 

CALL  PLOMO*  »C.*?I 

CALL  5YH»CLC1.73*5.3»0.1?tl7HI»!rENSIrY  PATTED’  »0  .  *  17 

> 

CALL  PLS  E 

rETU-”i 
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oo  oo  n  ^  o  v"  j'  nn  r>  n  o  n  n 


FTN  4*  >♦5*14 


\C/\ 


uri*  f.  H  Pr 


IJ  »■>  :iJTI  '.F  u  <  H  1  A*HSIB,  H324  »  (G?BeH334  ,H!  3B*T<;TAft  r  T  E^E 

»fo';.w»xp'  '  s»  y:  ■; 3 1 7Po*  .xoc  *  ,Yi'-:r , /  oor  tn: 3v,dt  :vp^*or svp.3« 

*..S  »  *»  VH  32  A  *  3  ;H»nVH::3A»«VHr>rB.,J«ASt'H?c»!>A,40EtSVHSlA*:,tfM3lBI 

■  EAL  SVH  :?A(.  C  ■»  )  ,  3VH;2U<  -03  )  f  GfH  ’  3A  <  ~  0  3  >  *5VH33B<200  * 

eal  svh  :  l a ( -•: •.-)  *'>vh-'1mc ?*;  d  ) 


•  ILL  3ETJ  THI  ;-ATf  e  the  C '"i S T A *1 T  n.  ILL  *'A';F'JVEP 
F0-  A  330  P'U  Ii  «  F.CS  :  r>LL=l  •  2  5  %  r» 

CLL=.5 

ALPHA  =  AT  A.‘i«7.P"S/XPC3) 

BE  T  A  =  A  TAE ( Yr  <  3/“ HCr  ) 

V  X  Z 2  =  (  XQ  C  T  *  *  <  ♦  ZD 0  T  *  *  2  > 

' DUX  Z  -  SO'-’  T <  V XZ2 ) 

:  I  MJ  =  3 1  f  <  C  B  F  '  A  > 

C * / 3 A  =  C  0 (  AL’  HA  ) 

. .IN A  =3  t\<  AL  HA) 

CT.  B=C0  ’  (BE  A) 


HG1B  =  <  <D  ISVA  ANGE)  *<  <  XDO  T  *  S  I  M  B  *  (  -  CO  3  A  )  )  *•  C  YDO  T  *COSB  >♦  (ZDO r *  0  I N8* 
tl  (-31*  A>>)>/(VMA5*.0Cr0<?> 

HS 1 A  "  (  (D  ’  SV  /  '  A-JGFD  *  (  CXD  0  T  *  (  -  3 1  'I  A  )  )  ♦(  Z OCT* COS  A  >  )  )/C((VMA  *•)>*•  3  OQO?) 
!F  ( * IME.GT . T FIN) GO  G  F3 
IF  (  MME  .LT.  *  STA-.T  )GC  6  0 

CGSW=CC3(HCLL*(r I  ME -TS TART )  ) 

•;  I  EM:-  s  I  \  ( P  OLL  *  (  T  I  ME- T$7  AP  T  )  ) 

3  DPPV--3Q0  •  (  XO  I  T**4M  YOOT**?>  *  (XOOT**?  )  *(2*  ( 

*  Xf)CT**2)  *(ZD  IT* *2)  IMZO'T**?)  *(Y90T**2)*f  ZD?  r***)  » 

G  O  '  t.  61 

0  :»PIM=G. 

CO  3  W  =  1  •  A 

0PP7-1 . 

1  :AVEA=((COGW*(-?OOT  )  )/CDVXZ)  ♦<  (3  I‘iU»YDGT*XDDr  >/nppv  ) 

:  A V ^ H  =  C  <  :  [\W*YDDT*ZDCT)/DP:>V)^((GCtW*XDOT)/3QVX7) 

DE L  A  -  (  f  3  A  VE  A  )  *  <  -  :  Hi  A)  )♦  C  3  A  VE  B*  3  3  A  ) 

DELB  =  (3  A  VEA*  I E  8  *  (-C'*  :  A  )  )  ♦  (  (  -V  X? 2  *  SI  W*Cr'  OB ) /DPP  V  ) 

*  msa/eh*  ■  i?;n*(!-;inA)) 

H3?A  =  (((0:3'/F2/:,AfiGF.)*0F.  LA)/»333P?) 

H‘320  =  C  ((OI3VP2/'*  ANGE)  *UE.  B)/.  0  3  0  OS) 

HJ  3 A  =  (  (  (  C) !  S VF  3  /P  AN  GE  )  *  DE\  A  )  /  .  0  3  3  0  2  ) 

HS3H=C f  < 0! SVP  5/*  AEGE  >  *DE . B ) / •  3  3  3  0?  ) 


.VHS1  A  CD--  )=H  1A 
f  VH51BCV'  )=H  IB 
3  VHVAC  ,c  )  =  H  Z  A 
*VH3-B<E' 
:VHC.5A(EH  )  =H 3 3 A 
3  VHC.  3B  ( '!  5  ) -H"  3B 
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Paul  P.  Millner  was  born  on  January  31,  1952  in 
Danville,  Virginia.  He  graduated  from  West  Mecklenburg 
High  School  in  Charlotte,  North  Carolina  in  June  1970 
and  entered  the  United  States  Military  Academy  at  West 
Point  in  July  of  the  same  year.  In  June  1974,  he 
graduated  from  West  Point  with  a  Bachelor  of  Science 
degree  and  was  commissioned  as  an  Army  Air  Defense 
officer.  Military  assignments  include:  Vulcan  platoon 
leader  and  executive  officer,  2nd  Armored  Division, 

Fort  Hood,  Texas;  Redeye  platoon  leader,  2nd  Infantry 
Division,  Korea;  Improved  HAWK  battery  commander,  11th 
Air  Defense  Artillery  Brigade,  and  instructor.  Department 
of  Tactics,  United  States  Army  Air  Defense  Artillery 
School,  Fort  Bliss,  Texas.  Captain  Millner  is  a  graduate 
of  the  Air  Defense  Artillery  Officers  Basic  and  Advanced 
Course.  In  June  1981,  Captain  Millner  was  assigned  to 
the  Air  Force  Institute  of  Technology  to  pursue  a  toasters 
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